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OF ESTIMATING JOINT MOMENTS OF BIPEDAL WALKING BODY 



< 

O 



(57) It is judged whether a rr Dtion state of leg bodies 
2 is a single stance state or a doi ible stance state. When 
it is the single stance state, a floe r reaction force F acting 
on the leg body 2 touching the ground is estimated 
based on the equation of motior for the center of gravity 
GO of a bipedal walking movinc; body 1 . When it is the 
double stance state, floor reaction forces -r. Ff respec- 
tively acting on the leg bodies 2 are estimated based on 
the equation of motion forthe ce nter of gravity GO of the 
bipedal walking moving body 1 and the expression of 
relation between components of the floor reaction forces 
Fr, Ff on the respective leg bodies 2 and positions of 
ankle portions 12 of the leg bodies 2 relative to the cent- 
er of gravity GO of the bipedal walking moving body 1 . 
Further, based on an inverse dynamics model using es- 
timated values of the floor reaction forces Fr, Ff, mo- 
ments acting on a knee joint 1 0 and a hip joint 8 of each 
leg body 2 are estimated. Thereby, floor reaction forces 
acting on leg bodies of a bipedal walking moving body 
such as a human being, and moments acting on joints 
of the leg bodies are accurately grasped in real time by 
a relatively simple technique. 
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Description 

TECHNICAL FIELD 

5 [0001] The present invention relates to a method of estimating floor reaction forces acting on leg bodies of a bipedal 
walking moving body such as c human being or a bipedal walking robot, and further relates to a method of estimating 
moments acting on joints of th 3 leg bodies of the bipedal walking moving body by the use of estimated values of the 
floor reaction forces. 

10 BACKGROUND ART 

[0002] For example, when e cecuting an operation control of a walking assist device assisting walking motions of a 
human being, or a control of moving motions of a bipedal walking robot, it becomes necessary to successively grasp 
floor reaction forces acting on I sg bodies (specifically, forces acting on ground touching portions of the leg bodies from 
15 a floor) of the human being or he bipedal walking robot. By grasping the floor reaction forces, it becomes possible to 
grasp moments or the like act ng on joints of the leg bodies of the bipedal walking moving body and, based on the 
grasped moments or the like, i: becomes possible to determine desired assist forces of the walking assist device, or 
desired driving torques for the respective joints of the bipedal walking robot or the like. 

[0003] As a technique of grasping the foregoing floor reaction forces, there has been known one disclosed in. for 
20 example, Laid-open Unexamined Patent Publication No. 2000-249570. According to this technique, in view of the fact 
that a waveform of temporal variation in floor reaction force on each leg body periodically changes during steady walking 
of a bipedal walking moving body, the floor reaction force on each leg body is grasped as a composite value (linear 
combination) of a plurality of trigonometric functions having mutually different periods being 1/n (n=1 , 2, •••) of a walking 
period. In this case, as a weighting coefficient of each trigonometric function upon combining the plurality of trigono- 
us metric functions, there has been used a prescribed value determined in advance per bipedal walking moving body, or 
a value obtained by adjusting i: depending on topography. 

[0004] However, inasmuch as the foregoing technique aims to grasp the floor reaction forces on the leg bodies with 
respect to one step or a plurality of steps of the bipedal walking moving body, when a gait of the bipedal walking moving 
body changes in sequence, it is difficult to accurately grasp the floor reaction forces. Further, for enhancing the accuracy 
30 of the floor reaction forces to be grasped, it is necessary to set the foregoing weighting coefficients of the trigonometric 
functions per bipedal walking moving body, or adjust them depending on topography or the like. Therefore, it is difficult 
to accurately grasp the floor reaction forces with a reduced influence of environment for movement of the bipedal 
walking moving body or a difference in individuality of the bipedal walking moving body. 

[0005] In case of a bipedal walking robot, for example, there has been known one wherein force sensors such as 
35 six-axis force sensors are attac hed to an^le portions or foot portions of respective leg bodies, and floor reaction forces 

are grasped by outputs of these force sensors. Further, there has also been known a technique of walking a bipedal 

walking moving body on a forco plate placed on a floor, and grasping floor reaction forces by outputs of the force plate. 

[0006] However, the technique using the force sensors has a disadvantage that when grasping floor reaction forces 

on leg bodies of particularly a human being, inasmuch as the force sensors should be attached to ankle portions or 
40 foot portions of the human bein g, the force sensors become obstructive to the walking in an ordinary living environment. 

Further, in case of the one usin g the force plate, the floor reaction forces can only be grasped in an environment where 

the force plate is arranged. 

[0007] The present inventior has been made in view of the foregoing background and has an object to provide a 
floor reaction force estimating r lethod that can accurately grasp floor reaction forces in real time with a relatively simple 
45 technique, and that is suitable 1 or graspirg floor reaction forces with respect to particularly a human being as a bipedal 
walking moving body. 

[0008] Further, it is an object thereof to provide a method of estimating joint moments of the bipedal walking moving 
body, which can accurately grasp in rea time the moments acting on joints such as knee joints of leg bodies by the 
use of estimated values of the floor reac:ion forces. 

50 

DISCLOSURE OF THE INVENTION 

[0009] At the outset, explanation will be given about a basic way of thinking about a floor reaction force estimating 
method of a bipedal walking moving body according to the present invention. 
55 [0010] As motion states of leg bodies of a bipedal walking moving body, for example, as motion states of the leg 
bodies upon walking, there are a single s:ance state wherein, as illustrated in Fig. 1 (a), only one leg body 2 (a leg body 
on a front side in an advancing direction in the figure) of both leg bodies 2, 2 of a bipedal walking moving body 1 touches 
the ground, and a double stance state wierein both leg bodies 2, 2 touch the ground as shown in Fig. 1 (b). 
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[0011] Here, first, in the forec oing single stance state, an equation of motion for the center of gravity (specifically, 
an equation of motion about translation of the center of gravity) of the bipedal walking moving body in an absolute 
coordinate system fixed relative to the gro jnd on which the bipedal walking moving body moves is given by an expres- 
sion of relation such that the p oduct of an acceleration of the center of gravity and a weight of the bipedal walking 

5 moving body is equal to a resul ant force of gravity acting on the center of gravity (=the weight of the bipedal walking 
moving body x the acceleration of gravity) and a floor reaction force acting from the floor on a ground touching portion 
of the leg body touching the gro jnd. Specifically, as shown in Fig. 1 (a), for example, in an absolute coordinate system 
Cf fixed relative to a floor A, g ^en that components of an acceleration a of the center of gravity GO of the bipedal 
walking moving body 1 in an X-axis direction (horizontal direction in the advancing direction of the bipedal walking 

10 moving body 1 ) and a Z-axis direction (vertical direction) are ax and az, respectively, and components of a floor reaction 
force F on the leg body 2 (leg b ody 2 on :he supporting leg side) touching the ground in the X-axis direction and the 
Z-axis direction are Fx and Fz, respectively, the equation of motion for the center of gravity GO is expressed by the 
following equation (1 ). 

15 T T 

(Fx, Fz-M • g) = M- (ax, az) (1) 

(wherein M: weight of bipedal walking moving body : and g: acceleration of gravity) 
[0012] Parenthesis portions 1 ( , ) on bolh sides in the equation (1 ) represent two-component vectors. In the present 
20 specification, the notation in th«> form of T ( . ) represents a vector. 

[0013] Therefore, if the acceleration a= T (ax, az) of the center of gravity GO of the bipedal walking moving body 1 is 
grasped, an estimated value of the floor reaction force F= T (Fx, Fz) can be derived by the following equation (2) using 
the acceleration a, a value of t »e weight M of the bipedal walking moving body 1 , and a value of the acceleration of 
gravity g. 
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T (Fx, Fz) = M • T (ax : az-g) (2) 

[0014] in this case, the weigit M necessary for deriving the estimated value of the floor reaction force F can be 
grasped in advance by measur *ment or tne like. Further, with respect to a position of the center of gravity GO and the 
acceleration a, it is possible to grasp them in sequence according to a known technique or the like using outputs of 
sensors such as sensors for detecting bending angles (rotation angles) of the respective joints of the bipedal walking 
moving body 1 , accelerometers , gyro sensors, and so forth, which will be described later in detail. 
[0015] Next, an equation of motion for :he center of gravity (specifically, an equation of motion about translation of 
the center of gravity) of the bipedal walking moving body in the foregoing both-leg ground touching state is given by 
an expression of relation such tnat the product of an acceleration of the center of gravity and the weight of the bipedal 
walking moving body is equal t"> a resultant force of gravity acting on the center of gravity (=the weight of the bipedal 
walking moving body x the acceleration of gravity) and floor reaction forces acting from the floor on the respective 
ground touching portions of botn leg bodies (two floor reaction forces corresponding to both leg bodies, respectively). 
Specifically, as shown in Fig. 1(b), given that X and Z coordinate components of a floor reaction force Ff on the leg 
body 2 on the front side in the c dvancing direction of the bipedal walking moving body 1 are Ffx and Ffz, and X and Z 
coordinate components of aflo)r reaction force Fr on the leg body 2 on the rear side are Frx and Frz, the equation of 
motion for the center of gravity GO is expressed by the following equation (3) 

T (Ffx+Frx, Ffz+Frz-M ■ g) = M • T (ax, az) (3) 
[0016] The meaning of ax, a; , M, and g in the equation (3) is as described before. 

[0017] On the other hand, ac wording to knowledge of the inventors of the present application, in the double stance 
state, the floor reaction forces Ff, Fr respectively relating to the leg bodies 2. 2 can be deemed to almost act from 
specific portions 12f, 12r (e.g. ankle portions) in the vicinity of lower end portions of the respective leg bodies 2, 2 
toward the center of gravity GO of the bipedal walking moving body 1 , as shown in Fig. 1 (b). Then, there is established 
an expression of certain relatic n between a position of the specific portion 12f, 12r of the leg body 2 relative to the 
center of gravity GO, and the t oor reaction force Ff, Fr acting on the leg body 2, that is, an expression of relation 
representing a relation wherein a direction of a segment connecting between the center of gravity GO and the specific 
portion 12f, 12r of the leg body 2 (a direction of a position vector of the specific portion 12f, 12r relative to the center 
of gravity GO) is the same as a direction of the floor reaction force Ff, Fr relating to the leg body 2. 
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[001 8] Specifically, referring to Fig. 1 (b). given that coordinates of a position of the center of gravity GO in the foregoing 
absolute coordinate system Cf are (Xg ; Zg), coordinates of a position of the specific portion 12f of the front-side leg 
body 2 are (Xf. Zf) ; and coordirates of a position of the specific portion 12r of the rear-side leg body 2 are (Xr, Zr), the 
foregoing expressions of relation become the following equations (4). 

5 

(Zf-Zg)/(Xf-Xg) - Ffz/Ffx 

(Zr-Zg)/(Xr-Xg) - Frz/Frx (4) 

10 

[0019] Then, the following eciuations (5) are obtained from these equations (4) and the foregoing equation (3). 



15 



20 



25 



-U = M ■ {AXf - (AZr - ax - AXr . az 

- AXr • g)} /(AXf - AZr - AXr ■ AZf) 
Ffz = M - {AZf • (AZr ■ ax - AXr • az 

- AXr • g)} /(AXf • AZr - AXr • AZf) 
Frx = M • {AXr • (-AZf • ax + AXf - az 

+ AXf • g)} /(AXf . AZr - AXr • AZf) 
F : rz - M - {AZr • (-AZf - ax + AXf • az 
+ AXf • g)} /(AXf • AZr - AXr . AZf) 



(5) 



30 (wherein AZf-Xf-Xg, AZf= Zf-Zg, AXr=Xr-Xg, and AZr=Zr-Zg) 

. [0020] Therefore, if an acceleration a= T (ax, az) of the center of gravity GO of the bipedal walking moving body 1 is 
grasped, and positions (these are expressed by AXf, AZf, AXr, and AZr in the equations (5)) of the specific portions 
1 2f , 1 2r respectively of the leg I >odies 2, 2 relative to the center of gravity GO of the bipedal walking moving body 1 are 
grasped, estimated values of tie floor reaction forces Ff= T (Ffx, Ffz), Fr= T (Frx, Frz) on the respective leg bodies 2, 2 

35 can be obtained by the foregoir g equations (5) using a value of the weight M and a value of the acceleration of gravity 
g of the bipedal walking moving Dody 1 and the grasped acceleration a and the positions of the specific positions 1 2f , 12r. 
[0021] in this case, the weigf t M necessary for obtaining the estimated values of the floor reaction forces Ff, Fr can 
be grasped in advance by mea surement or the like. With respect to the acceleration a of the center of gravity GO, the 
position of the center of gravity GO, and the positions of the specific portions 12f, 12r relative to the center of gravity 

40 GO, although details will be de* cribed later, it is possible to grasp them in sequence by a known technique or the like 
using outputs of the sensors detecting bending angles (rotation angles) of the respective joints of the bipedal walking 
moving body 1 , the accelerom* ters, the gyro sensors, and so forth. 

[0022] The present invention will be described next on the basis of what has been explained above. For accomplishing 
the foregoing objects, a methoc: of estimating a floor reaction force for a bipedal walking moving body according to the 

45 present invention, i.e. a methoc of estimating a floor reaction force acting on each leg body of a bipedal walking moving 
body, comprises a first step of udging whether a motion state of the leg bodies of said bipedal walking moving body 
is a single stance state in which only one of the leg bodies touches the ground, or a double stance state in which both 
leg bodies touch the ground; a second step of sequentially deriving positions of the center of gravity of said bipedal 
walking moving body, and sequentially deriving accelerations of said center of gravity in an absolute coordinate system 

so fixed relative to the ground by the use of time series data about the positions of said center of gravity; and a third step 
of sequentially deriving positions of a specific portion relative to said center of gravity at least in said double stance 
state s said specific portion predetermined in the neighborhood of a lower end portion of each leg body. Then, the method 
of estimating a floor reaction f( rce of the present invention is characterized by further comprising a step of deriving 
estimated values of said floor taction force acting on the leg body touching the ground sequentially, in the single 

55 stance state of said bipedal wa <ing moving body, based on an equation of motion for said center of gravity expressed 
by a weight and an acceleration of gravity of the bipedal walking moving body, the acceleration of said center of gravity, 
and said floor reaction force acting on the leg body touching the ground; and a step of deriving estimated values of 
said floor reaction forces respectively acting on both leg bodies sequentially, in the double stance state of said bipedal 
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walking moving body, based on an equation of motion for said center of gravity expressed by a weight and an accel- 
eration of gravity of the bipedal walking moving body ; the acceleration of said center of gravity, and said floor reaction 
forces respectively acting on bo- h leg bodies, and an expression of relation between the position of said specific portion 
of each leg body relative to said center of gravity and said floor reaction force acting on said leg body, said expression 
5 of relation being determined bai ed on assumption that said floor reaction force acting on each leg body acts from said 
specific portion of said leg body toward said center of gravity. 

[0023] According to the present invention as described above, in the foregoing first step, it is judged whether the 
motion state of the leg bodies oi the bipedal walking moving body is the single stance state or the double stance state, 
and the estimated values of the oregoing floor reaction forces are derived by the techniques depending on the respec- 
10 tive supporting states. Specif iceilly, in the single stance state of the bipedal walking moving body, the estimated value 
of the foregoing floor reaction force acting on the leg body touching the ground is derived from values of the weight, 
the acceleration of gravity, and the acceleration of the center of gravity of the bipedal walking moving body (see the 
equation (2)) based on the foregoing equation of motion for the center of gravity of the bipedal walking moving body 
(see the equation (1 )). 

15 [0024] On the other hand, in the double stance state of the bipedal walking moving body, the estimated values of 
the floor reaction forces acting c n both leg bodies, respectively, are derived from the weight, the acceleration of gravity, 
and the acceleration of the center of gravity of the bipedal walking moving body, and the position of the specific portion 
of each leg body relative to the center of gravity (see the equations (5)) based on the foregoing equation of motion for 
the center of gravity of the bipedal walking moving body (see the equation (3)) and the expression of relation (the 

20 equation (4)) between the position of the specific portion of each leg body relative to the foregoing center of gravity, 
and the foregoing floor reaction force acting on the subject leg body. Incidentally, in the single stance state, the floor 
reaction force acting on the free-leg side leg body (the leg body not touching the ground) is "0". 
[0025] In this case, the weight of the bipedal walking moving body necessary for deriving the estimated value of the 
floor reaction force may be grasped in advance by measurement or the like. With respect to the position of the center 

25 of gravity and the acceleration of the bipedal walking moving body, and the position of the specific portion of each leg 
body relative to the center of gravity, it is possible to grasp them in real time using data about outputs of sensors that 
are relatively small in size and easy to be attached to the bipedal walking moving body, such as sensors (potentiometers 
or the like) detecting bending angles (rotation angles) of the respective joints of the bipedal walking moving body, 
accelerometers. gyro sensors, and so fonh. 

50 [0026] Therefore, according t d the method of estimating a floor reaction force of the present invention, it is possible 
to grasp the floor reaction force;; in real time by the relatively simple technique without attaching force sensors to ankle 
portions or foot portions of the I >ipedal walking moving body, or using a force place. 

[0027] In the method of estim ating a floor reaction force of the present invention as described above, it is preferable 
that the specific portion of eacn leg body is an ankle portion of the leg body. Thereby, particularly, reliability of the 
foregoing assumption in the bo h-leg ground touching state is enhanced. Therefore, the accuracy of not only the esti- 
mated value of the floor reaction force in the foregoing single stance state, but also the estimated values of the floor 
reaction forces in the double sta ice state can be enhanced. That is, the floor reaction force can be accurately estimated 
irrespective of the motion state of the leg bodies. 

[0028] Further the method of estimating a floor reaction force of the present invention comprises a step of measuring 
40 an acceleration, in an upward/cownward direction, of a lower portion of a body supported on both leg bodies via a hip 
joint of each leg body, said low* r portion of the body located near said hip joints, wherein, in said first step, the motion 
state of said bipedal walking m< >ving body is judged such that when the acceleration of said lower portion of the body 
in the upward/downward dired on increases to a predetermined threshold value or more, said double stance state 
starts while said single stance itate finishes and, when the estimated value of said floor reaction force acting on the 
45 leg body which precedingly makes a takeoff is lowered to a predetermined threshold value or less in said double stance 
state, said double stance state "inishes while said single stance state starts. 

[0029] Specifically, upon transition of the motion state of the leg bodies from the single stance state to the double 
stance state during movement (walking) of the bipedal walking moving body, landing of the free-leg side leg body 
causes the acceleration of a low er part of a body in an upward/downward direction (upward acceleration) to temporarily 

^o become remarkably large. This phenomenon is not generated normally in the other motion state of the leg bodies. On 
the other hand, upon transition of the motion state of the leg bodies from the double stance state to the single stance 
state, a takeoff operation of one of the leg bodies causes the floor reaction force acting on that leg body to be lowered 
to "0". Therefore, by judging the motion state of the leg bodies as described above, judgement as to whether it is the 
single stance state or the double stance state can be properly carried out. As a result, a floor reaction force estimated 

55 value calculation method that differs between the single stance state and the double stance state can be switched at 
appropriate timing to thereby increase the accuracy of the estimated value of the floor reaction force. The acceleration, 
in the upward/downward direction, of the lower part of the body necessary forjudging the motion state of the leg bodies 
can be easily grasped from an output of an accelerometer by, for example, attaching the accelerometer to the lower 
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part of the body. 

[0030] Like a human being, if the foregoing body has a waist coupled to both leg bodies via hip joints, and a chest 
located on the waist so as to bo tilted freely relative to the waist, it is preferable that the acceleration, in the upward/ 
downward direction, of the lowei part of the body to be measured is an acceleration of the waist in the upward/downward 
5 direction. 

[0031] Further in the methoc of estimating a floor reacLion force of the present invention, various techniques are 
considered as a technique of gr asping the position of the center of gravity of the bipedal walking moving body and the 
acceleration of the center of gr avity in the foregoing second step, and it is possible to use various known methods. 
However it is preferable to grasp the position of the center of gravity and the acceleration of the center of gravity 

10 according to the following method. 

[0032] Specifically, the method comprises a step of respectively measuring an inclination angle of a body supported 
on both leg bodies via a hip join of each leg body, bending angles respectively of at least the hip joint and a knee joint 
of each leg body, and an acceleration of & predetermined reference point of said bipedal walking moving body in said 
absolute coordinate system, wherein, in said second step, based on the inclination angle of said body, the bending 

15 angles respectively of said hip oints and said knee joints, a rigid body link model formed by expressing said bipedal 
walking moving body as a linked body of a plurality of rigid bodies, prederived weights of respective rigid-body corre- 
sponding portions of the bipedal walking moving body corresponding to the respective rigid bodies of said rigid body 
link model, and positions of the orederived centers of gravity of the rigid-body corresponding portions in the respective 
rigid-body corresponding portiens, positions of the center of gravity of said bipedal walking moving body relative to 

20 said reference point are sequentially derived, accelerations of said center of gravity relative to said reference point are 
sequentially derived based on ime series data about the positions of said center of gravity, and the acceleration of 
said center of gravity in said aosolute coordinate system is derived from the acceleration of said center of gravity 
relative to said reference point, and the acceleration of said reference point in said absolute coordinate system. 
[0033] Specifically, when the eference point is arbitrarily set to the bipedal walking moving body, the position of the 

25 center of gravity of the bipedal talking moving body relative to the reference point is almost determined by a mutual 
posture relationship among the body, a thigh portion of each leg body from the hip joint to the knee joint, and a cms 
portion on a lower side below fie knee joint. By measuring the inclination angle of the body and the bending angles 
respectively of the hip joints ar d the knee joints, the posture relationship can be grasped from those measurement 
data. Further, although details will be described later, when the foregoing rigid body link model is supposed for the 

30 bipedal walking moving body (e.g. a model regarding as rigid bodies a portion (including the body) on an upper side 
of the hip joints of both leg bocies of the bipedal walking moving body : and the thigh portion and the cms portion of 
each leg body), the position of the center ot gravity of the bipedal walking moving body relative to the foregoing reference 
point can be derived based on he weights of the respective rigid-body corresponding portions of the bipedal walking 
moving body, the positions of fie centers of gravity of the rigid-body corresponding portions in the respective rigid- 

35 body corresponding portions (specifically, the positions of the rigid-body corresponding portions in coordinate systems 
fixed to the respective rigid-bocy corresponding portions), and the foregoing posture relationship. Further, the accel- 
eration of the center of gravity relative to ^he reference point can be derived as a second-order differentiated value of 
the position of the center of gravity which is grasped from time series data about the positions of the center of gravity. 
Therefore, by measuring the acceleration of the reference point in the foregoing absolute coordinate system, the ac- 

40 celeration of the center of gravit t of the bipedal walking moving body in the absolute coordinate system can be derived 
as a composite acceleration of he acceleration of the center of gravity relative to the reference point and the acceler- 
ation of the reference point. 

[0034] In this case, the incline tion angles of the body necessary for grasping the acceleration of the bipedal walking 
moving body as described abo\e can be grasped from outputs of accelerometers and gyro sensors, or inclinometers 
45 or the like attached to the body and the bending angles of the hip joint and the knee joint of each leg body can be 
grasped from outputs of sensor, such as potentiometers attached to the portions of the respective joints. Further, the 
acceleration of the reference pc int in the absolute coordinate system can be grasped from outputs of sensors such as 
accelerometers attached to a pc rtion integral with the reference point. Further, the weights of the respective rigid-body 
corresponding portions of the bbedal walking moving body and the positions of the centers of gravity of the rigid-body 
corresponding portions in the respective rigid-body corresponding portions can be grasped in advance by measurement 
or the like. 

[0035] Therefore, it becomes possible to easily grasp in real time the position and acceleration of the center of gravity 
of the bipedal walking moving body without mounting the relatively large sensors and so forth onto the bipedal walking 
moving body, 

55 [0036] When deriving the position and acceleration of the center of gravity of the bipedal walking moving body as 
described above, it is preferable that the reference point is set to the body. Thereby, the sensors such as the acceler- 
ometers for measuring the acceleration of the reference point in the absolute coordinate system can be mounted on 
the body, and therefore, the sensors attached to the leg bodies can be reduced, thereby to make it possible to avoid 



50 



7 



NSDOCID: <EP "I415770A1 J_> 



EP1 415 770 A1 



the situation where those sensors become obstructive to walking motions of the bipedal walking moving body. 
[0037] On the other hand, like a human being, if the body has a waist coupled to both leg bodies via hip joints, and 
a chest located on the waist sc as to be tiltabie relative to the waist, it is preferable that the inclination angle of the 
body used for deriving the posi ion of the center of gravity comprises inclination angles respectively of the waist and 
5 the chest. Particularly in this ca >e, it is preferable that the foregoing rigid body link model is a model expressing a crus 
portion located on a lower side of the knee joint of each leg body of the bipedal walking moving body, a thigh portion 
between the knee joint and the hip joint, the waist and an upper body portion located on an upper side of the waist 
and including the chest, as rigid bodies, respectively. 

[0038] In accordance therew th, particularly when the bipedal walking moving body is a human being, the position 
10 of the center of gravity thereof a id the acceleration thereof can be grasped accurately to thereby enhance the accuracy 
of the estimated values of the floor reaction forces. 

[0039] When deriving the pos tion of the center of gravity of the bipedal walking moving body relative to the reference 
point based on the inclination angles of the body and so forth as described above, the position of the foregoing specific 
portion of each leg body relative to the center of gravity of the bipedal walking moving body can be derived by deriving 

15 the position of the specific portion relative to the reference point in the foregoing third step. In this case, parameters 
necessary for deriving the positi :>n of the soecific portion relative tothe reference point differ depending on a set position 
of the reference point. For example, when the specific portion is an ankle portion of each leg body, and the reference 
point is set to the body, it is poss ble to derive the position of the specific portion of each leg body relative to the reference 
point based on the inclination a lgle of the body (the inclination angle of the waist when the body has the waist and the 

20 chest, and the reference point s set to the waist), the bending angles of the hip joint and the knee joint of each leg 
body, and the sizes (lengths) o the thigh portion and the crus portion of each leg body. 

[0040] Next, a method of esti nating a moment for a bipedal walking moving body according to the present invention 
is a method of estimating a monent acting on at least one joint of each leg body of the bipedal walking moving body 
by the use of the estimated val jes of the floor reaction force on each leg body sequentially derived by the foregoing 
25 method of estimating a floor reaction force. Then, the method of estimating a moment of the present invention is 
characterized by comprising a step of respectively measuring an inclination angle of a body supported on both leg 
bodies via a hip joint of each le< j body, bending angles respectively of at least the hip joint and a knee joint of each leg 
body, and an acceleration of a predetermined reference point of said bipedal walking moving body in said absolute 
coordinate system; a step of sequentially deriving inclination angles of respective rigid-body corresponding portions 
30 of the bipedal walking moving body corresponding to the respective rigid bodies of said rigid body link mode!, based 
on the inclination angle of said body, the bending angles respectively of said hip joint and said knee joint of each leg 
body, and a rigid body link mode I formed by expressing said bipedal walking moving body as a linked body of a plurality 
of rigid bodies; a step of sequentially deriving positions of the centers of gravity of the respective rigid-body corre- 
sponding portions relative to seid reference point, based on the inclination angles of said respective rigid-body corre- 
35 spending portions, prederived v/eights of the respective rigid-body corresponding portions, and positions of the pred- 
erived centers of gravity of the igid-body corresponding portions in the respective rigid-body corresponding portions, 
and sequentially deriving acce arations of the centers of gravity of the respective rigid-body corresponding portions 
relative to said reference point based on time series data about the positions of the centers of gravity of the respective 
rigid-body corresponding portions; a step of sequentially deriving accelerations of the centers of gravity of the respective 
rigid-body corresponding portions in said absolute coordinate system from the accelerations of the centers of gravity 
of the respective rigid-body coresponding portions relative to said reference point, and the accelerations of said ref- 
erence point in said absolute CDordinate system: a step of sequentially deriving angular velocities of the respective 
rigid-body corresponding portions based on time series data about the inclination angles of the respective rigid-body 
corresponding portions; a step « >f sequentially deriving estimated positions of a floor reaction force acting point of each 
45 leg body in said bipedal walkin j moving body, based on at least one of an inclination angle of a thigh portion of said 
leg body and the bending angls of the knee joint of said leg body as the rigid-body corresponding portions of said 
bipedal walking moving body; end a step of estimating a moment acting on at least one of the joints of each leg body 
of said bipedal walking movinc body based on an inverse dynamics model using the estimated value of said floor 
reaction force, the estimated position of said floor reaction force acting point, the accelerations of the centers of gravity 
of the respective rigid-body corr sspondinc portions and the angular velocities of said rigid-body corresponding portions 
in said absolute coordinate system, the inclination angles of the respective rigid-body corresponding portions, the 
prederived weights and sizes of the respective rigid-body corresponding portions, the positions of the prederived cent- 
ers of gravity of the rigid-body corresponding portions in the respective rigid-body corresponding portions, and pred- 
erived moments of inertia of th* respective rigid-body corresponding portions. 

[0041 ] When, as described be fore, the second step in the foregoing floor reaction force estimating method comprises 
a step of respectively measuring the inclination angle of the body : the bending angles respectively of the hip joint and 
the knee joint of each leg body, and the acceleration of the reference point of the bipedal walking moving body in the 
absolute coordinate system, for deriving the position of the center of gravity of the bipedal walking moving body relative 
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25 



to the reference point, and so forth, it is not necessary to newly measure them. Further the rigid body link model may 
be the same as the rigid body I nk mode! used for deriving the position of the center of gravity of the bipedal walking 
moving body, and so forth. 

[0042] in the method of estimating a moment of the present invention as described above, by measuring the incli- 

5 nation angle of the body and the bending angles respectively of the hip joints and the knee joints, it is possible to grasp, 
from those measurement data, nclination angles of the respective rigid-body corresponding portions (these represent 
a mutual posture relationship of the respective rigid-body corresponding portions), such as the body, the thigh portions, 
the cms portions, and so forth, - )f the bipedal walking moving body. Then, based on the weights of the respective rigid- 
body corresponding portions, tie positions of the centers of gravity of the rigid-body corresponding portions in the 

10 respective rigid-body corresponding portions (specifically, the positions of the rigid-body corresponding portions in 
coordinate systems fixed to the r espective rigid-body corresponding portions), and the inclination angles of the respec- 
tive rigid-body corresponding portions, it is possible to derive the positions of the centers of gravity of the respective 
rigid-body corresponding portions with respect to the reference point. Further the acceleration of the center of gravity 
of each rigid-body corresponding portior relative to the reference point is derived as a second-order differentiated 

is value of the position of the cen:er of gravity which is grasped from time series data about the positions of the center 
of gravity. Therefore, by measuring the acceleration of the reference point in the absolute coordinate system, the 
acceleration of the center of gravity of each rigid-body corresponding portion of the bipedal walking moving body in 
the absolute coordinate system can be derived as a composite acceleration of the acceleration of the center of gravity 
relative to the reference point and the acceleration of the reference point (the acceleration in the absolute coordinate 

20 system). 

[0043] Further, an angular ve locity of each rigid-body corresponding portion is derived as a second-order differenti- 
ated value of the inclination an^le which is grasped from time series data about the inclination angles of each rigid- 
body corresponding portion. 

[0044] According to knowledc e of the inventors of the present application, the position of a floor reaction force acting 
point of each leg body in the b pedal walking moving body, for example, the position of a floor reaction force acting 
point of each leg body relative 1 o the ankle portion of the leg body, has a close correlation with the inclination angle of 
the thigh portion of each leg bo- Jy as the rigid-body corresponding portion of the bipedal walking moving body, and the 
bending angle of the knee joint of each leg body. Therefore, it is possible to derive an estimated position of the floor 
reaction force acting point in the bipedal walking moving body based on at least one of the inclination angle of the thigh 
30 portion of each leg body and tr b bending angle of the knee joint thereof. 

[0045] Then, when the accelerations of the centers of gravity of the respective rigid-body corresponding portions of 
the bipedal walking moving body, the angular velocities of the respective rigid-body corresponding portions, and the 
estimated position of the floor taction force acting point are derived as described above, it is possible to estimate 
moments acting on the knee jcint and the hip joint of each leg body based on a known so-called inverse dynamics 
model, using those data and so orth along with the estimated values of the floor reaction forces derived by the foregoing 
fioor reaction force estimating n lethod. Briefly speaking, the technique based on this inverse dynamics model uses the 
equation of motion for the translation motion of the center of gravity of each rigid-body corresponding portion of the 
bipedal walking moving body, ai id the equation of motion for the rotating motion of the rigid-body corresponding portion 
(e.g. the rotating motion about the center of gravity of the rigid-body corresponding portion), and derives moments 
acting on the respective joints >f the bipedal walking moving body corresponding to the respective joints of the rigid 
body link model, in order from the joint closer to the floor reaction force acting point. Although details will be described 
later, assuming that, for example, each leg body is a linked body having a thigh portion and a crus portion as rigid- 
body corresponding portions, respectively, a force (joint reaction force) acting on a knee joint of the leg body can be 
grasped by applying an acceleration of the center of gravity of the crus portion, an estimated value of a floor reaction 
45 force acting on the leg body, and a value of the weight of the cms portion, into the equation of motion for the translation 
motion of the center of gravity c c the crus portion of each leg body. Further, a moment on the knee joint of the leg body 
can be estimated by applying a joint reaction force acting on the knee joint of the leg body, an angular velocity of the 
crus portion of the leg body, an estimated position of a floor reaction force acting point of the leg body, an estimated 
value of a floor reaction force on the leg body, data values relating to a position of the center of gravity of the cms 
portion in the crus portion and a size (length) of the crus portion, a value of a moment of inertia of the crus portion, and 
a value of an inclination angle o the crus portion, into the equation of motion forthe rotating motion of the crus portion. 
[0046] Further, a joint reactioi i force acting on a hip joint of the leg body can be grasped by applying an acceleration 
of the center of gravity of the thigh portion, a joint reaction force acting on the knee joint of the leg body, and a value 
of the weight of the thigh portion, into the equation of motion for the translation motion of the center of gravity of the 
thigh portion. Further, a moment on the hip joint of the leg body can be estimated by applying joint reaction forces 
respectively acting on the knee joint and the hip joint of the leg body, an angular velocity of the thigh portion of the leg 
body, data values relating to a position of the center of gravity of the thigh portion in the thigh portion and a size (length) 
of the thigh portion, a value of & moment of inertia of the thigh portion, and a value of an inclination angle of the thigh 
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portion, into the equation of mo :ion for the rotating motion of the thigh portion. 

[0047] According to the meth )d of estimating a moment of the present invention as described above, by estimating 
the moments acting on the join :s of the leg bodies using the estimated values of the floor reaction forces derived by 
the foregoing floor reaction for:e estimating method of the present invention, it is possible to relatively accurately 
5 estimate in real time the mome its acting on the joints of the leg bodies without attaching the relatively large sensors 
and so forth to the bipedal walking moving body. 

BRIEF- DESCRIPTION OF THE DRAWINGS 

w [0048] Fig. 1 is a diagram for sxplaining the basic principle of a floor reaction force estimating method of the present 
invention, Fig. 2 is a diagram e>emplarily showing a human being as a bipedal walking moving body and structures of 
devices attached to the human being in one embodiment of the present invention, Fig. 3 is a block diagram for explaining 
functions of an arithmetic processing uni: provided in the devices of Fig. 2, and Fig. 4 is a diagram showing a rigid 
body link model used in the processing of the arithmetic processing unit of Fig. 3. Fig. 5 is a diagram showing a 

15 correlation between advancing direction components of a floor reaction force acting point vector and an inclination 
angle of a thigh portion during normal walking, Fig. 6 is a diagram showing a correlation between vertical direction 
components of a floor reaction force acting point vector and an inclination angle of a thigh portion during normal walking, 
Fig. 7 is a diagram showing a correlation between advancing direction components of a floor reaction force acting point 
vector and a bending angle of a knee joint upon sitting in a chair. Fig. 8 is a diagram showing a correlation between 

20 advancing direction components of a floor reaction force acting point vector and a bending angle of a knee joint upon 
standing up from a chair, Fig. 9 is a diagram showing a correlation between advancing direction components of a floor 
reaction force acting point vector and an inclination angle of a thigh portion upon going upstairs, and Fig. 1 0 is a diagram 
showing a correlation between advancing direction components of a floor reaction force acting point vector and an 
inclination angle of a thigh portion upon going downstairs. Fig. 11 is a diagram for explaining the processing in joint 

25 moment estimating means of the arithmetic processing unit of Fig. 3, Fig. 12 is a graph illustrating the states of temporal 
variations of estimated values of floor reaction forces during normal walking, which are derived by the embodiment of 
the present invention, Fig. 13 is a graph illustrating the states of temporal variations of estimated values of floor reaction 
forces upon going upstairs, whi< ;h are derived by the embodiment of the present invention, Fig. 1 4 is a graph illustrating 
the state of temporal variation Df estimated values of floor reaction forces upon standing up from a chair, which are 

30 deriveid by the embodiment of t le presenl invention, and Fig. 15 is a graph illustrating the states of temporal variations 
of estimated values of momenls on a knee joint and a hip joint, which are derived by the embodiment of the present 
invention. 

BEST MODE FOR CARRYING OUT THE INVENTION 

35 

[0049] One embodiment of tr e present invention will be described with reference to the foregoing figure 1 and Figs. 
2 to 10. 

[0050] The present embodiment is an embodiment wherein a floor reaction force estimating method and a method 
of estimating a moment of the present invention are applied to a human being as a bipedal walking moving body. 

40 [0051] As exemplarily showr in Fig. 2. a human being 1, when its structure is roughly classified, has a pair of left 
and right leg bodies 2, 2, a bod r 5 comprising a waist 3 and a chest 4, a head 6, and a pair of left and right arm bodies 
7, 7. The waist 3 is coupled to he respective leg bodies 2, 2 via a pair of left and right hip joints 8. 8 so that the body 
5 is supported on both leg bod es 2, 2. Further, the chest 4 of the body 5 is disposed on an upper side of the waist 3 
so as to be free inclined toward a forward side of the human being 1 relative to the waist 3. And, the arm bodies 7, 7 

45 extend from both left and right side portions of an upper part of the chest 4, and the head 6 is supported at an upper 
end portion of the chest 4. 

[0052] Each of the leg bodies 2, 2 has a thigh portion 9 extending from the hip joint 8, and a cms portion 1 1 extending 
from a tip of the thigh portion 9 via a knee joint 1 0, and a foot portion 1 3 is coupled to a tip portion of the crus portion 
11 via an ankle portion (ankle joint) 12. 
50 [0053] In the present embodiment, for estimating a floor reaction force acting on each leg body 2 of the human being 
1 having the foregoing structure, and further estimating moments acting on the knee joint 10 and the hip joint 8, the 
human being 1 is equipped with the following devices. 

[0054] Specifically, the chest 4 of the bady 5 is mounted with a gyro sensor 14 (hereinafter referred to as the chest 
gyro sensor 14) that produces an output corresponding to an angular velocity following an inclination of the chest 4, 
55 an accelerometer 15 (hereinafter referred to as the chest forward/backward accelerometer 15) that produces an output 
corresponding to an acceleration of the chest 4 in a forward/backward direction, an arithmetic processing unit 1 6 com- 
prising a CPU, a RAM, a ROM, and so foih, and a battery 17 serving as a power supply for the arithmetic processing 
unit 16 and so forth. In this case, these chest gyro sensor 14, chest forward/backward accelerometer 15, arithmetic 
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processing unit 1 6, and battery 1 7 are : for example, received in a reception member 1 8 in the form of a shoulder bag 
that is fixed to the chest 4 using < belt or the like not shown, and unitarily fixed to the chest 4 via the reception member 1 8 . 
[0055] The acceleration repre sented by the output of the chest accelerometer 1 5 is. more specifically, an acceleration 
in a forward/backward direction in a direction of horizontal section of the chest 4 (a direction perpendicular to a central 

5 axis of the chest 4). In the statu where the human being 1 is standing erect on a flatland, it is an acceleration in the 
forward/backward horizontal diiection (X-axis direction of the absolute coordinate system in Fig. 2), while, in the state 
where the waist 3 or the chest 4 s inclined from the vertical direction (Z-axis direction of the absolute coordinate system 
in Fig. 2), it is an acceleration h a directisn inclined relative to the horizontal direction by an inclination angle of the 
chest 4 relative to the vertical c rection. 

10 [0056] Further a gyro sensor 1 9 (hereinafter referred to as the waist gyro sensor 1 9) for producing an output corre- 
sponding to an angular velocity following an inclination of the waist 3, an accelerometer 20 (hereinafter referred to as 
the waist forward/backward aa elerometer 20) for producing an output corresponding to an acceleration of the waist 
3 in a forward/backward direct; Dm and an accelerometer 21 (hereinafter referred to as the waist upward/downward 
accelerometer 21) for producirg an output corresponding to an acceleration of the waist 3 in an upward/downward 

15 direction are unitarily mounted/ ixed to the waist 3 of the body 5 via fixing means such as a belt not shown. 

[0057] Here, the waist forwa d/backwa r d accelerometer 20 is, more specifically, a sensor, like the chest forward/ 
backward accelerometer 15, fo- detecting an acceleration in a forward/backward direction in a direction of horizontal 
section of the waist 3 (a direction perpendicular to a central axis of the waist 3). Further, the waist upward/downward 
accelerometer 21 is. more specifically, a sensor for detecting an acceleration in an upward/downward direction in a 

20 direction of the central axis of the waist 3 (this is perpendicular to the acceleration detected by the waist forward/ 
backward accelerometer 20). Ir cidentally, the waist forward/backward accelerometer 20 and the waist upward/down- 
ward accelerometer 21 may be unitarily formed as a two-axis accelerometer. 

[0058] Further, the hip joint 8 and the knee joint 1 0 of each leg body 2 are mounted with a hip joint angle sensor 22 
and a knee joint angle sensor 2 3 that produce outputs corresponding to respective bending angles A0c and A6d. With 
25 respect to the hip joint angle sensors 22, although only the hip joint angle sensor 22 relating to the hip joint 8 of the 
leg body 2 on this side (the right side of the human being 1 facing forward) is shown in Fig. 2, the hip joint 8 of the leg 
body 2 on the other side (the le t side of the human being 1 facing forward) is mounted with the hip joint angle sensor 
22 concentrically with the hip joint angle sensor 22 on this side. 

[0059] These angle sensors >2 and 23 are formed by : for example, potentiometers, and attached to each leg body 

30 2 via means such as a band member not shown. Here, the bending angle A6c detected by each hip joint angle sensor 
22 is, more specifically, a rotatiDn angle of the thigh portion 9 of the leg body 2 about the hip joint 8 (about a central 
axis of the hip joint 8 in a leftwa'd/rightwa'd direction of the human being 1) relative to the waist 3, using as a criterion 
the state where a posture relationship between the waist 3 and the th igh portion 9 of the leg body 2 is in a predetermined 
posture relationship (e.g. a posture relationship in which the central axis of the waist 3 and a central axis of the thigh 

35 portion 9 become substantially parallel to each other as in an erect posture state of the human being 1). Likewise, the 
bending angle A8d detected b\ each knee joint angle sensor 23 is a rotation angle of the crus portion 11 about the 
knee joint 10 (about a central exis of the knee joint 10 in a leftward/rightward direction of the human being 1) relative 
to the thigh portion 9, using as a criterion the state where a posture relationship between the thigh portion 9 and the 
crus portion 11 of the teg body 2 is in a predetermined posture relationship (e.g. a posture relationship in which the 

40 central axis of the thigh portion d and a central axis of the crus portion 11 become substantially parallel to each other). 
[0060] incidentally, the foregc ing respective sensors 14, 15, and 1 9 to 23 are connected to the arithmetic processing 
unit 1 6 via signal lines not shown, for inputting outputs thereof into the arithmetic processing unit 1 6. 
[0061 ] The foregoing arithme :ic processing unit 1 6 is provided with functional means as shown in Fig. 3. Specifically, 
the arithmetic processing unit ' 6 is provided with leg body motion judging means 24 forjudging whether the motion 

45 state of the leg bodies 2, 2 of he human being 1 is the single stance state (state of Fig. 1(a)) or the double stance 
state (state of Fig. 1(b)), usinc detection data of the waist upward/downward accelerometer 21 and data about an 
estimated value of a floor read ion force of each leg body 2 derived by later-described floor reaction force estimating 
means 36. Further, the arithme ic processing unit 1 6 is provided with chest inclination angle measuring means 25 for 
measuring an inclination angle )a of the cnest 4 in the absolute coordinate system Cf (specifically, an inclination angle 

50 ea relative to, for example, the vertical direction; see Fig. 2), using detection data of the chest forward/backward ac- 
celerometer 1 5 and the chest gyro sensor 1 4, and waist inclination angle measuring means 26 for measuring an incli- 
nation angle 0b of the waist 3 ir the absolute coordinate system Cf (specifically, an inclination angle Gb relative to, for 
example, the vertical direction; see Fig. 2), using detection data of the waist forward/backward accelerometer 20 and 
the waist gyro sensor 19. 

55 [0062] Further, the arithmetic processing unit 16 is provided with reference acceleration measuring means 27 for 
deriving an acceleration (translation acceleration) a 0 = T (a 0 x ; aoz), in the absolute coordinate system Cf, of the origin O 
of a body coordinate system Cp (xz coordinates in Fig. 2) which is set at the waist 3 as a reference point of the human 
being 1 in the present embodiment as shown in Fig. 2, using detection data of the waist forward/backward accelerometer 
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20 and the waist upward/downw ard accelerometer 21 and data about the inclination angle Bb of the waist 3 measured 
by the foregoing waist inclination angle measuring means 26. Here, the body coordinate system Cp is, more specifically, 
a coordinate system (coordinate system of which directions of three axes are the same as those of the foregoing 
absolute coordinate system Cf) wherein the origin O is set to, for example, a middle point of a line connecting the 

5 respective centers of the left ar d right hio joints 8, 8 of the human being 1 , a z-axis direction is set to the vertical 
direction, and an x-axis direction is set to the horizontal direction headed forward of the human being 1 . 
[0063] Further, the arithmetic processing unit 16 is provided with leg body posture calculating means 28 for deriving 
inclination angles Be and 0d resp ectivety of the thigh portion 9 and the crus portion 1 1 of each leg body 2 in the absolute 
coordinate system Cf (specifically, inclination angles Be and Bd relative to, for example, the vertical direction; see Fig. 

10 2) , using detection data of the h p joint angle sensor 22 and the knee joint angle sensor 23 of the leg body 2 and data 
about the inclination angle Ob of the waist 3 by the foregoing waist inclination angle measuring means 26. 
[0064] Further, the arithmetic processing unit 1 6 is provided with respective-portion center of gravity position calcu- 
lating means 29 for deriving pos tions of the centers of gravity of respective rigid-body corresponding portions (specif- 
ically, positions of the centers of gravity of respective rigid-body corresponding portions in the foregoing body coordinate 

1^ system Cp) of the human being 1 corresponding to a later-described rigid body link model, using data about the incli- 
nation angle 8a of the chest 4, tie inclination angle 6b of the waist 3, and the inclination angle 6c of the thigh portion 
9 and the inclination angle Bd of he crus portion 1 1 of each leg body 2 obtained by the foregoing chest inclination angle 
measuring means 25, waist incl nation angle measuring means 26, and leg body posture calculating means 28, body 
center of gravity position calcu le ting means 30 for deriving a position of the center of gravity of the whole human being 

20 1 in the foregoing body coordine te system Cp, using data about the positions of the centers of gravity of the respective 
rigid-body corresponding portio is, ankle position calculating means 31 for deriving, using data about the position of 
the center of gravity GO of the v r hole human being 1 (see Fig. 1 ; hereinafter referred to as the body center of gravity 
GO) and data about the respect ve inclination angles Be and Bd of the thigh portion 9 and the crus portion 11 of each 
body leg 2 by the foregoing leg body posture calculating means 28, a position of the ankle portion 12 of each leg body 

25 2, as a specific part of each lec 2 in the present embodiment, relative to the body center of gravity GO (specifically, 
AXf, AZf, AXr, and AZr in the fo egoing equations (5)), and body center of gravity acceleration calculating means 32 
for deriving an acceleration a= T i ax, az) (see Fig. 1) of the body center of gravity GO in the absolute coordinate system 
Cf, using data about the position of the body center of gravity by the foregoing body center of gravity position calculating 
means 30 and data about the acc eleration a 0 of the origin O of the body coordinate system Cp by the foregoin g reference 

30 acceleration measuring means 17. 

[0065] Further, the arithmetic processing unit 1 6 is provided with leg body respective-portion acceleration calculating 
means 33 for deriving accelerat ons (translation accelerations) of the centers of gravity of the thigh portion 9 and the 
crus portion 11 , respectively, of sach leg body 2 in the absolute coordinate system Cf, using data about the positions 
of the centers of gravity of the -espective rigid-body corresponding portions of the human being 1 (specifically, the 

35 positions of the centers of gravity of the rigid-body corresponding portions relating to each leg body 2) by the foregoing 
respective-portion center of gra/ity position calculating means 29 and data about the acceleration a 0 of the origin O 
of the body coordinate system Cp by the foregoing reference acceleration measuring means 27 : leg body respective- 
portion angular velocity calculat ng means 34 for deriving angular velocities of the thigh portion 9 and the crus portion 
11 of each leg body 2 in the absolute coordinate system Cf, using data about the respective inclination angles 6c and 

40 Gd of the thigh portion 9 and the crus portion 11 of the leg body 2 by the foregoing leg body posture calculating means 
28, and floor reaction force acti lg point estimating means 35 for estimating a position of a floor reaction force acting 
point of each leg body 2 touchir g the ground, using data about the inclination angle Be of the thigh portion 9 derived 
by the foregoing leg body postu e calculating means 28 and the bending angle ABd of the knee joint 1 0 measured by 
the foregoing knee joint angle s ?nsor 23. 

45 [0066] Further, the arithmetic | >rocessing unit 1 6 is provided with floor reaction force estimating means 36 for deriving 
an estimated value of a floor reaction force acting on each leg body 2, using data about the acceleration a of the body 
center of gravity by the foregoin g body center of gravity acceleration calculating means 32, data about the position of 
the ankle portion 12 of each leg DOdy 2 relative to the body center of gravity by the foregoing ankle position calculating 
means 31 , and data about the j jdgement result on the motion state of the leg bodies 2, 2 by the foregoing leg body 

50 motion judging means 24, and j >int moment estimating means 37 for estimating moments acting on the knee joint 1 0 
and the hip joint 8, respectively of each leg body 2, using data about this estimated value of the floor reaction force, 
data about the accelerations of l he centers of gravity of the thigh portion 9 and the crus portion 1 1 of each leg body 2 
by the foregoing leg body respective-portion acceleration calculating means 33, data about the angular velocities of 
the thigh portion 9 and the cru:» portion 11 of each leg body 2 by the leg body respective-portion angular velocity 

55 calculating means 34, data about the estimated position of the floor reaction force acting point by the floor reaction 
force acting point estimating means 35, and data about the inclination angles Be and Bd of the thigh portion 9 and the 
crus portion 11 , respectively, of each leg body 2 by the foregoing leg body posture calculating means 28. 
[0067] Now, an operation of this embodiment will be described along with more detailed processing contents of the 
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respective means of the forego rig arithmetic processing unit 16. 

[0068] In the present embod ment, when the human being 1 turns on a power supply switch, not shown, of the 
arithmetic processing unit 16 in the state where both leg bodies 2, 2 are on the floor upon, for example, moving the 
leg bodies 2, 2, such as walkirg, the processing by the arithmetic processing unit 16 is executed in sequence per 
5 predetermined cycle time as wt I be described hereinbelow, to thereby successively derive estimated values of floor 
reaction forces and so forth act ng on each leg body 2. 

[0069] Specifically, at the outs eL the arithmetic processing unit 1 6 executes the processing of the foregoing leg body 
motion judging means 24. In th<= processing of the leg body motion judging means 24. detection data about the accel- 
eration of the waist 3 in the upward direction by the foregoing waist upward/downward accelerometer 21 is compared 

10 with a prescribed threshold valt e determined in advance per the foregoing cycle time Then, when a detected value 
of the acceleration exceeds the threshold value, it is judged that the double stance state as shown in the foregoing 
figure 1 (b) starts, while the singlo stance state as shown in the foregoing figure 1 (a) finishes. Specifically, upon transition 
from the single stance state to :he double stance state during walking of the human being 1, landing of the free-ieg 
side leg body 2 on the floor causes the waist 3 near the hip joints 8 to produce a substantially upward and relatively 

15 large acceleration (acceleration that can r ot be produced in the normal single stance state). Therefore, by comparing 
the detection data about the acceleration of the waist 3 in the upward direction by the waist upward/downward accel- 
erometer 21 with the prescribec threshold value as described above, the foregoing leg body motion judging means 24 
judges the start of the double s ance state and the finish of the single stance state. 

[0070] Further, in the proces >ing of the leg body motion judging means 24. of estimated values of floor reaction 

20 forces Ff and Fr (see Fig. 1(b); acting on both leg bodies 2, 2, respectively, which are derived in the double stance 
state by the floor reaction force estimating means 35 as will be described later, the estimated value of the floor reaction 
force Fr- T (Frx ; Frz) (specifically , an absolute value =W(Frx 2 4- Frz 2 ) of the floor reaction force Fr derived at the previous 
cycle time of the arithmetic proc ?ssing unit 1 6) acting on the leg body 2 on a rear side relative to the advancing direction 
of the human being is compared with a prescribed threshold value (positive value approximately "0") determined in 

25 advance. Then, when the absol Jte value of the estimated value of the floor reaction force Fr is lowered to the threshold 
value or less, it is judged that t le double stance state finishes and the single stance state starts. In the present em- 
bodiment, the initial state of the motion state of the leg bodies 2, 2 is the double stance state, and the leg body motion 
judging means 24 judges that tr e motion state of the leg bodies 2, 2 is the double stance state until an estimated value 
of a floor reaction force acting c n either one of the leg bodies 2, 2 is lowered to the foregoing threshold value or less. 

30 [0071] In parallel with the processing of the leg body motion judging means 24 as described above, the arithmetic 
processing unit 1 6 executes th * processing by the foregoing chest inclination angle measuring means 25 and waist 
inclination angle measuring means 26. In this case, in the processing of the chest inclination angle measuring means 
25, an inclination angle 6a of th< * chest 4 in the absolute coordinate system Cf is derived in sequence per the foregoing 
cycle time according to a know ) technique using the processing of a so-called Kalman filter, based on detection data 

35 about the acceleration of the cf est 4 in the forward/backward direction and the angular velocity of the chest 4 which 
are inputted from the chest forv ard/backward accelerometer 15 and the chest gyro sensor 14, respectively. Likewise, 
in the processing of the waist inc lination angle measuring means 25, an inclination angle 9b of the waist 3 in the absolute 
coordinate system Cf is derivec in sequence using the processing of the Kalman filter, based on detection data about 
the acceleration of the waist 3 in the fon/vard/backward direction and the angular velocity of the waist 3 which are 

40 inputted from the waist forwarc 'backward accelerometer 20 and the waist gyro sensor 19, respectively. Here, in the 
present embodiment, the incliration angles 9a and eb respectively of the chest 4 and the waist 3 in the absolute 
coordinate system Cf are inclin ation angles relative to, for example, the vertical direction (direction of gravity). 
[0072] It is also possible to de ive inclination angles of the chest 4 and the waist 3 by, for example, integrating detection 
data about angular velocities b) the gyro sensors 1 4 and 19. However like in the present embodiment, the inclination 

45 angles Ba and Bb of the chest 4 and the waist 3 can be accurately measured using the processing of the Kalman filter. 
[0073] Then, the arithmetic piocessing unit 16 executes the processing of the foregoing leg body posture calculating 
means 28 and the processing cf the foregoing reference acceleration measuring means 27. 

[0074] In the processing by tie foregoing leg body posture calculating means 28, inclination angles 6c and 6d (in- 
clination angles relative to the vertical direction; see Fig. 2) of the thigh portion 9 and the crus portion 11 of each leg 
50 body 2 in the absolute coordine te system Cf are derived per the foregoing cycle time in the following manner. Specif- 
ically, the inclination angle 0c of he thigh portion 9 of each leg body 2 is calculated from a current-time value of detection 
data about the bending angle A 3c of the hip joint 8 by the foregoing hip joint angle sensor 22 attached to the leg body 
2 and a current-time value of t le inclination angle eb of the waist 3 derived by the foregoing waist inclination angle 
measuring means 25, using the following equation (6). 

55 

6c = eb + A0c (6) 
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[0075] Here, the inclination ai igle 9b of "he waist 3 takes a negative value when the waist 3 is inclined relative to the 
vertical direction such that an u )per end portion of the waist 3 is projected forward of the human being 1 as compared 
with a lower end portion therecf ; and the bending angle ABc of the hip joint 8 takes a positive value when the thigh 
portion 9 is inclined relative to [he central axis of the waist 3 such that a lower end portion of the thigh portion 9 is 
projected forward of the humar being 1 . 

[0076] Further, the inclinatior angle Bd of the crus portion 11 of each leg body 2 is calculated from a current-Lime 
value of the inclination angle tiz of the thigh portion 9 derived in Lhe foregoing manner and a current-time value of 
detection data about the bendir g angle AOd of the knee joint 1 0 by the foregoing knee joint angle sensor 23 attached 
to the leg body 2. using the following equation (7). 

0d - 0c - ABd (7) 

[0077] Here, the bending ang e of the knee joint 1 0 takes a positive value when the crus portion 1 1 is inclined relative 

15 to the central axis of the thigh portion 9 toward the back side of the thigh portion 9. 

[0078] Further in the processing of the foregoing reference acceleration measuring means 27, an acceleration a 0 = T 
(a0x : aOz) of the origin O of the foregoing body coordinate system Cp in the absolute coordinate system Cf is derived 
in the following manner. Speci T ically, given that a current-time value of detection data about the acceleration of the 
waist 3 in the forward/backwa d direction by the foregoing waist forward/backward accelerometer 20 is ap, and a 

20 current-time value of detection data about the acceleration of the waist 3 in the upward/downward direction by the 
foregoing waist upward/downward accelerometer 21 is aq, the acceleration a 0 = T (a 0 x, a 0 z) in the absolute coordinate 
system Cf is derived from those detection data ap and aq, and a current-time value of the inclination angle 0b of the 
waist 3 derived by the foregoing waist inclination angle measuring means 25, using the following equation (8). 

25 T 

a 0 - (a 0 x,a o z) 

= T (ap • cosOb - aq • sinOb, ap • sinBb + aq ■ cosBb - g) (8) 

30 [0079] Then, the arithmetic p ocessing unit 16 executes the processing of the foregoing respective-portion center of 
gravity position calculating means 29, and derives positions (positions relative to the origin of the body coordinate 
system Cp) of the centers of gravity of respective rigid-body corresponding portions of the human being 1 in the fore- 
going body coordinate system 3p, using a rigid body link model described hereinbelow. 

[0080] As shown in Fig. 4, a igid body link model R used in the present embodiment is a model that expresses the 
35 human being 1 by linking together rigid bodies R1 , R1 corresponding to the thigh portions 9 of the respective leg bodies 
2, 2, rigid bodies R2, R2 corres ponding to the crus portions 11,11,8 rigid body R3 corresponding to the waist 3 ; and 
a rigid body R4 corresponding to a portion 38 (hereinafter referred to as the upper body portion 38) in a combination 
of the foregoing chest 4, arm b >dies 7, 7, and head 6. In this case, a linkage portion between each rigid body R1 and 
the rigid body R3, and a linkage portion between each rigid body R1 and the rigid body R2 correspond to the hip joint 
40 8 and the knee joint 10, respectively. Further, a linkage portion between the rigid body R3 and the rigid body R4 is a 
tilting fulcrum portion 39 for the chest 4 relative to the waist 3. 

[0081] In the present embod ment, positions of the centers of gravity G1 , G2, G3, and G4 of the rigid-body corre- 
sponding portions (the thigh portion 9 and the crus portion 11 of each leg body 2, the waist 3. and the upper body 
portion 38) of the human being 1 corresponding to the respective rigid bodies R1 to R4 of such a rigid body link model 
45 R, in the respective rigid-body corresponding portions, are derived in advance and stored in a memory, not shown, of 
the arithmetic processing unit " 6. 

[0082] Here, the positions of the centers of gravity G1 , G2, G3, and G4 of the respective rigid-body corresponding 
portions stored/retained in the arithmetic processing unit 16 are positions each in a coordinate system that is fixed 
relative to each rigid-body corresponding portion . In this case, as data representing each of the positions of the centers 

50 of gravity G1 , G2. G3, and G4 o f the respective rigid-body corresponding portions, for example, a distance in a direction 
of the central axis of the rigid-body corresponding portion from the central point of a joint at one end portion of such a 
rigid-body corresponding portion is used. Specifically, for example, as shown in Fig. 4, the position of the center of 
gravity G1 of each thigh portion 9 is given as a position with a distance t1 in the direction of the central axis of the thigh 
portion 9 from the center of the: hip joint 8 of the thigh portion 9, the position of the center of gravity G2 of each crus 

55 portion 11 is given as a position with a distance t2 in the direction of the central axis of the crus portion 11 from the 
center of the knee joint 1 0 of the crus portion 1 1 , and values of those distances t1 and t2 are derived in advance and 
stored/retained in the arithmetics processing unit 1 6. This also applies to the positions of the centers of gravity G3, G4 
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of the other rigid-body corresponding portions. 

[0083] Strictly speaking, the position of the center of gravity G4 of the upper body portion 38 is affected by movement 
of the arm bodies 7 7 included n the upper body portion 38 However inasmuch as the arm bodies 7, 7 during walking 
generally make a symmetrical f: ositiona! relationship relative to the central axis of the chest 4, the position of the center 
5 of gravity G4 of the upper bod'' portion 38 does not change much, and is, for example, substantially equivalent to a 
position of Ihe center of gravity G4 of Lhe upper body portion 38 in the erect posture state. 

[0084] Further, in the presenl embodiment, in addition to the data representing the positions of the centers of gravity 
G1 , Gi2 ; G3, and G4 of the resr. ective rigid-body corresponding portions (the thigh portion 9 and the crus portion 1 1 of 
each leg body 2. the waist 3, e nd the upper body portion 38), data about weights of the respective rigid-body corre- 
fo sponding portions, and data at out sizes of the respective rigid-body corresponding portions (e.g. data about lengths 
of the respective rigid-body corresponding portions) are derived in advance and stored/retained in the arithmetic 
processing unit 16. 

[0085] The weight of the cru ; portion 11 is a weight including the foot portion 13. Further, the data stored/retained 
beforehand in the arithmetic piocessing unit 16 as described above may be obtained by actual measurement or the 

15 tike, or may be estimated from a height and weight of the human being 1 based on human average statistical data. In 
general, the positions of the cer ters of gravity G1 , G2, G3, and G4, the weights, and the sizes of the foregoing respective 
rigid-body corresponding portic ns have correlation with a height or weight of a human being and, based on the corre- 
lation, it is possible to estimate relatively accurately the positions of the centers of gravity G1 , G2, G3, and G4, the 
weights, and the sizes of the foregoing respective rigid-body corresponding portions from data about the height and 

20 weight of the human being. 

[0086] The foregoing resped ive-portion center of gravity position calculating means 29 derives positions of the cent- 
ers of gravity G1 , G2, G3, and G4 of the respective rigid-body corresponding portions in the body coordinate system 
Cp (xz coordinates in Fig. 4) h iving the origin O fixed to the waist 3. from the data stored/retained beforehand in the 
arithmetic processing unit 16 es described above, current-time values of the inclination angle 8a of the chest 4 (=the 

25 inclination angle of the upper tody portion 38) and the inclination angle 0b of the waist 3 respectively derived by the 
foregoing chest inclination ang e measuring means 25 and waist inclination angle measuring means 26, and current- 
time values of the inclination a ngles 9c and 8d respectively of the thigh portion 9 and the crus portion 11 of each leg 
body 2 derived by the foregoing leg body posture calculating means 28. 

[0087] In this case, since the inclination angles 0a to Gd of the respective rigid-body corresponding portions (the thigh 
30 portion 9 and the crus portion 1 of each leg body 2, the waist 3, and the upper body portion 38) are derived as described 
above, the positions and postLres of the respective rigid-body corresponding portions in the body coordinate system 
Cp can be derived from data at; out the inclination angles Oa to Bd and data about the sizes of the respective rigid-body 
corresponding portions. There ore, the positions of the centers of gravity G1 , G2 ( G3, and G4 of the respective rigid- 
body corresponding portions ir the body coordinate system Cp are derived. 
35 [0088] Specifically, for exam Die, referring to Fig. 4, with respect to the leg body 2 located on the left side in Fig. 4, 
since an inclination angle of ths thigh portion 9 in the body coordinate system Cp (an inclination angle relative to the 
z-axis direction) is 6c (in this case, 9c<0 in Fig. 4), coordinates of the position of the center of gravity G1 of the thigh 
portion 9 in the body coordinale system Cp become (t1 - sin Gc, -t1 - cos Gc). On the other hand, since an inclination 
angle of the crus portion 11 in the body coordinate system Cp is 8d (9d<0 in Fig. 4), given that a length of the thigh 
40 portion 9 is Lc, coordinates of the position of the center of gravity G2 of the crus portion 11 in the body coordinate 
system Cp become (Lc - sin 9c + 12 • sin 9d, -Lc • cos 9c - 12 - cos 9d). The centers of gravity of the thigh portion 9 and 
the crus portion 1 1 of the other eg body 2, the waist 3, and the upper body portion 38 can also be derived as described 
above. 

[0089] After deriving the positions of the centers of gravity G1 , G2, G3, and G4 of the respective rigid-body corre- 
45 sponding portions in the body coordinate system Cp by the respective-portion center of gravity position calculating 
means 29 as described above, the arithmetic processing unit 16 executes the processing of the foregoing body center 
of gravity position calculating means 30, and derives a position (xg, zg) of the body center of gravity GO of the human 
being 1 in the body coordinate system Cp using data about the positions of the centers of gravity G1 , G2, G3, and G4 
of the respective rigid-body cor esponding portions and data about the weights of the respective rigid-body correspond- 
50 ing portions. 

[0090] Here, given that the p osition of the center of gravity G3 of the waist 3 in the body coordinate system Cp and 
the weight thereof are (x3, z3) and m3, respectively, the position of the center of gravity G4 of the upper body portion 
38 and the weight thereof are ( <4, z4) and m4, respectively, the position of the center of gravity G1 of the thigh portion 
9 of the leg body 2 on the left s de of the human being 1 facing forward and the weight thereof are (x1 L, z1 L) and ml L f 
55 respectively, the position of the center of gravity G2 of the crus portion 1 1 of the same leg body 2 and the weight thereof 
are (x2L, z2L) and m2L, respectively, the position of the center of gravity G1 of.the thigh portion 9 of the leg body 2 on 
the right side and the weight thereof are (x1 R, z1 R) and ml R, respectively, the position of the center of gravity G2 of 
the crus portion 1 1 of the same leg body 2 and the weight thereof are (x2R, z2R) and m2R, respectively, and the weight 
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of the human being 1 is M (=m1 L-Hn2L+m1 R+m2R+m3+m4). the position (xg, zg) of the body center of gravity GO of 
the human being 1 in the body coordinate system Cp is derived by the following equations (9). 

5 ::g = (ml L • x1 L + ml R • x1 R + m2L • x2L + m2R ■ x2R 

+ m3 • x3 + m4 • x4) / M 
;:g = (m1L • z1 L + ml R - z1 R + m2L - z2L + m2R • z2R 

10 

+ m3 - z3 + m4 • z4) / M (9) 

[0091 ] After executing the processing of the body center of gravity position calculating means 30 as described above, 
the arithmetic processing unit 1 3 further executes the processing of the foregoing body center of gravity acceleration 

15 calculating means 32 and the processing of the foregoing ankle position calculating means 31 . 

[0092] In this case : in the pro :essing of the body center of gravity acceleration calculating means 32, at the outset, 
using time series data about tho positions (xg, zg) of the body center of gravity GO in the body coordinate system Cp 
derived by the body center of g-avity position calculating means 30 per the foregoing cycle time, a second-order dif- 
ferentiated value of the position (xg, zg) of the body center of gravity GO in the body coordinate system Cp, that is, an 

20 acceleration T (d 2 xg/dt 2 ; d 2 zg/dt ■) of the body center of gravity GO relative to the origin O of the body coordinate system 
Cp, is derived. Then, by deriving the vector sum of the acceleration T (d 2 xg/dt 2 , d 2 zg/dt 2 ) and the acceleration a 0 = T 
(a 0 x, a 0 z), derived by the foregc ing reference acceleration measuring means 27, of the origin O of the body coordinate 
system Cp in the absolute cooidinate system Cf, an acceleration a= T (ax, az) of the body center of gravity GO in the 
absolute coordinate system Cf s derived 

25 [0093] Further, in the procesi ing of the foregoing ankle position calculating means 31 . at the outset, from current- 
time values of data about the in :lination angles 6c and 6d respectively of the thigh portion 9 and the cms portion 1 1 of 
each leg body 2 derived by the foregoing leg body posture calculating means 28, a current-time value of data about 
the inclination angle Gb of the v aist 3 derived by the foregoing waist inclination angle measuring means 26, and data 
about the sizes (lengths) of the thigh portion 9 and the crus portion 11 , a position of the ankle portion 12 of each leg 

30 body 2 in the foregoing body coordinate system Cp is derived by the processing like the processing of the foregoing 
respective-portion center of gra vity position calculating means 29. Specifically, referring to Fig. 4, with respect to the 
leg body 2 located on the left s de in Fig. 4, given that a length of the crus portion 11 (a length from the center of the 
knee joint 1 0 to the ankle porti< n 1 2) is Ld, coordinates (x1 2, z1 2) of the position of the ankle portion 1 2 in the body 
coordinate system Cp become Lc ■ sin ec + Ld • sin 6d, - Lc • cos ec - Ld - cos 6d) (wherein 6c<0 and 6d<0 in Fig. 4). 

35 This also applies to the other leg body 2. 

[0094] Then, from current-tirr e values of data about the position (x12, z12) of the ankle portion 12 in the body coor- 
dinate system Cp and the posit on (xg, zg) of the body center of gravity GO in the body coordinate system Cp derived 
by the foregoing body center of gravity position calculating means 30, a position vector T (x1 2-xg, z1 2~zg) of the ankle 
portion 12 of each leg body 2 relative to the body center of gravity GO, that is, AXf, AZf, AXr, and AZr in the foregoing 

40 equations (5), are derived. 

[0095] Then, the arithmetic p-ocessing means 16 executes the processing of the foregoing floor reaction force es- 
timating means 36 in the follow ng manner. Specifically, in this processing, when the motion state of the leg bodies 2, 
2 determined by the foregoing eg body motion judging means 24 at the current cycle time is the single stance state, 
an estimated value of a floor reaction force F= T (Fx, Fz) acting on the leg body 2 touching the ground is derived from 

45 values of the weight M and the acceleration of gravity g of the human being 1 (these are stored beforehand in the 
arithmetic processing unit 16) aid a current-time value of the acceleration a= T (ax. az) of the body center of gravity GO 
in the absolute coordinate syst ?rm Cf derived by the foregoing body center of gravity acceleration calculating means 
32, using the foregoing equatic n (2). In this case, a floor reaction force acting on the ground non-touching side leg 
body 2 (the free-leg side leg bedy 2) is T (0, 0). 

50 [0096] On the other hand, wr en the motion state of the leg bodies 2, 2 determined by the leg body motion judging 
means 24 at the current cycle t me is the double stance state, estimated values of floor reaction forces Ff= T (Ffx, Ffz) 
and Fr= T (Frx, Frz) on the respective leg bodies 2, 2 are derived from the weight M and the acceleration of gravity g of 
the human being 1 , a current-tir le value of the acceleration a= T (ax, az) of the body center of gravity GO in the absolute 
coordinate system Cf derived b/ the foregoing body center of gravity acceleration calculating means 32, and current- 

55 time value data about the posit on of the ankle portion 12 of each leg body 2 relative to the body center of gravity GO 
(current-time values of data about AXf, AZf, AXr, and AZr in the equations (5)) derived by the foregoing ankle position 
calculating means 31 , using the foregoing equations (5). 

[0097] On the other hand, in oarallel to the processing of the body center of gravity position calculating means 30, 
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the body center of gravity acceleration calculating means 32, the ankle position calculating means 31 . and the floor 
reaction force estimating mean ; 36 as described above, the arithmetic processing unit 16 executes the processing of 
the foregoing leg body respecti /e-portion acceleration calculating means 33, leg body respective-portion angular ve- 
locity calculating means 34, an i floor reaction force acting point estimating means 35. 

5 [0098] In this case, in the processing of the foregoing leg body respective-portion acceleration calculating means 
33, at the outset, like in the foregoing body center of gravity acceleration calculating means 32, using time series data 
about the positions of the cente s of gravity G1 and G2 respectively of the thigh portion 9 and the crus portion 1 1 being 
the rigid-body corresponding portions of each leg body 2 in the body coordinate system Cp, which are derived by the 
foregoing respective-portion ce iter of gravity position calculating means 29 per the foregoing cycle time, second-order 

10 differentiated values of the positions of the centers of gravity G1 and G2 respectively of the thigh portion 9 and the 
crus portion 11 in the body cocdinate system Cp, that is, accelerations (accelerations relative to the origin O of the 
body coordinate system Cp) of tie respective centers of gravity G1 and G2 of the thigh portion 9 and the crus portion 
11 in the body coordinate system Cp, are derived. Then, by deriving the vector sum of these respective accelerations 
and the acceleration a 0 = T (a 0 x, a 0 z) of the waist 3 in the absolute coordinate system Cf by the foregoing reference 

15 acceleration measuring means 27, accelerations (more specifically, coordinate components of the accelerations in the 
absolute coordinate system Cf respectively of the thigh portion 9 and the crus portion 11 in the absolute coordinate 
system Cf are derived. 

[0099] Further, in the processing of the foregoing leg body respective-portion angular velocity calculating means 34, 
using time series data about th^ inclination angles 6c and 6d respectively of the thigh portion 9 and the crus portion 

20 11 of each leg body 2 derived by the foregoing leg body posture calculating means 28 per the foregoing cycle time, 
second-order differentiated val jes of the respective inclination angles 6c and 9d of the thigh portion 9 and the crus 
portion 11 , that is, angular velo :ities respectively of the thigh portion 9 and the crus portion 11 , are derived. 
[0100] Further, in the processing of the floor reaction force acting point estimating means 35, with respect to the leg 
body 2 touching the ground, a > ector (position vector of a floor reaction force acting point relative to the ankle portion 

25 12; hereinafter referred to as th 3 floor reaction force acting point vector) from the ankle portion 12 of the leg body 2 to 
a floor reaction force acting po nt of the foot portion 13 of the leg body 2 (a point upon which the total floor reaction 
force acting on a ground touch ng portion of the foot portion 13 is considered to be concentrated) is derived as data 
representing a position of the fh >or reaction force acting point, from, for example, a current-time value of the inclination 
angle Gc of the thigh portion 9 d< rived by the foregoing leg body posture calculating means 28, based on predetermined 

30 correlations as shown in Figs. i> and 6. 

[0101] Specifically, according to knowledge of the inventors of the present application, the inclination angle 8c of the 
thigh portion 9 or the bending angle A6d of the" knee joint 10 of the leg body 2 touching the ground has relatively 
significant correlation with the lloor reaction force acting point. The foregoing floor reaction force acting point vector, 
specifically, components of the floor reaction force acting point vector in the advancing direction (X-axis direction) of 

35 the human being 1 , and compor ents of the floor reaction force acting point vector in the vertical direction (Z-axis vector), 
respectively change with respect to, for example, the inclination angle 6c of the thigh portion 9 as shown in FIGS. 5 
and 6. Here, the negative inclination angle ec of the thigh portion 9 is an angle when the thigh portion 9 is inclined 
relative to the central axis of th< waist 3 so that the leg body 2 extends to the back side of the human being 1 (e.g. the 
leg body 2 on the right side of t le human being 1 facing forward in Fig, 2), while the positive inclination angle ec is an 

40 angle when the thigh portion 9 s inclined relative to the central axis of the waist 3 so that the leg body 2 exists on the 
front side of the human being 1 (e.g. the leg body 2 on the left side of the human being 1 facing forward in Fig. 2). 
[0102] Therefore, in the present embodiment, approximate expressions using the inclination angle Be of the thigh 
portion 9 as a parameter, which -epresent the correlations of Figs. 5 and 6, are prepared and stored/ retained in advance 
in the arithmetic processing unil 1 6. Then, in the processing of the foregoing floor reaction force acting point estimating 

45 means 35, a current-time valuo of the inclination angle Be of the thigh portion 9 derived by the foregoing leg body 
posture calculating means 28 is put in the foregoing approximate expressions to thereby derive the foregoing floor 
reaction force acting point vector (specifically, components of the floor reaction force acting point vector in the X-axis 
direction and Z-axis direction). 

[0103] Here, in the correlations as shown in Figs. 5 and 6 wherein the inclination angle 6c of the thigh portion 9 has 
50 a minimal value, even when th* inclination angle 6c of the thigh portion 9 is the same, a value of the floor reaction 
force acting point vector differs I >etween a decreasing stage of the inclination angle 6c and an increasing stage thereof. 
Therefore, in the present embo iiment, upon preparing the foregoing approximate expression, a transition of the fore- 
going correlation from a landinc of the heel of the foot portion 1 3 on the floor to a takeoff of the tiptoe from the floor is 
classified into a first phase (a phase of a1 in Fig. 5; a phase of b1 in Fig. 6) wherein the inclination angle Gc of the thigh 
55 portion 9 is positive, a second phase (a phase of a2 in Fig. 5; a phase of b2 in Fig. 6) wherein the inclination angle 0c 
of the thigh portion 9 is negative and a changing speed of the inclination angle Gc of the thigh portion 9, i.e. an inclination 
angular velocity of the thigh po tion 9, is negative, and a third phase (a phase of a3 in Fig. 5: a phase of b3 in Fig. 6) 
wherein the inclination angle Gc of the thigh portion 9 is negative, and an inclination angular velocity of the thigh portion 
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9 is positive, andthe phases are approximated by the same function or differentfu notions with respectto X-axis direction 
components and Z-axis directic n components of the floor reaction force acting point vector, respectively. An approxi- 
mate expression of a phase in a combination of the first and second phases a1 and a2 in the correlation of Fig. 5 is, 
given that the X-axis direction components of the floor reaction force acting point vector are px ; expressed by ; for 
5 example, a sixth-order polynorr ial function in the form of 

px = x 1 ■ tic 6 + x 2 • 6c 5 + x 3 • 6c 4 
w + x 4 • Be 3 +■ x 5 • tic 2 +x 6 • Bcf x 7 

(x 1 to x 7 are constant vah-es). 
Further, an approximate exprei sion of the third phase a3 in the correlation of Fig. 5 is expressed by, for example, a 
fourth-order polynomial function in the form of 

15 

p x = x 8 • Be 4 + x 9 ■ tic° + x 10 • 6c 2 4- x 1 1 • Be + x 12 
(x 8 to x 12 are constant va ues). 

20 [0104] Further, an approxima:e expression of a phase in a combination of the first and second phases b1 and b2 in 
the correlation of Fig. 6 is, giver that the Z-axis direction components of the floor reaction force acting point vector are 
pz, expressed by, for example, a sixth-order polynomial function in the form of 

25 PZ = Z t • 6C 6 + Z 2 - 6c 5 4- Z 3 • GC 4 

+ z 4 ■ Gc 3 + z 5 • Be 2 + z 6 • 9c +- z 7 

(z 1 to z 7 are constant values). 

30 Further, an approximate exprej;sion of the third phase b3 in the correlation of Fig. 5 is expressed by, for example, a 
third-order polynomial function in the form of 

pz - z 8 • Be 3 + z 9 • Oc 2 4- z 10 ■ Be 4- z^ 

35 

(x 8 to x 1A are constant va ues). 
[0105] Then, upon deriving the floor reaction force acting point vector, it is judged whether the inclination angle Gc 
of the thigh portion 9 is positiv j or negative, and further judged whether the inclination angular velocity of the thigh 
portion 9 calculated by first-ordsr differentiation of time series data about the inclination angles Be of. the thigh portion 

40 9 is positive or negative. Furth sr, from judged positive or negative of the inclination angle Be and judged positive or 
negative of the inclination angi lar velocity, it is judged which of the phases is manifested currently and, by putting a 
current-time value of the inclina ion angle Be of the thigh portion 9 into the approximate expression of the judged phase, 
the floor reaction force acting p< int vector is calculated. Thereby, the value of the floor reaction force acting point vector 
in the decreasing stage of the ir clination angle Be of the thigh portion 9, and the value of the floor reaction force acting 

45 point vector in the increasing si age thereof can be discriminatingly calculated. 

[0106J In the present embodiment, the correlation between the inclination angle 6c of the thigh portion 9 of the leg 
body and the floor reaction for ;e acting point vector is approximated by the polynomials to thereby derive the floor 
reaction force acting point vector. However, it is also possible to store/retain the correlations shown in Figs. 5 and 6 in 
the form of a data table and, us ng the data table, derive the floor reaction force acting point vector from the inclination 

50 angle 0c of the thigh portion 9, 

[0107] Further, the position o the floor reaction force acting point also has correlation with the bending angle of the 
knee joint 1 0 of the leg body 2 t Duching the ground. Therefore, the position of the floor reaction force acting point may 
be estimated from the bending angle ABd of the knee joint 1 0 measured by the knee joint angle sensor 23, instead of 
the inclination angle Be of the tnigh portion 9. Alternatively, using both the inclination angle Be of the thigh portion 9 

55 and the bending angle ABd of trie knee joint 1 0, the position of the floor reaction force acting point may be estimated 
by the use of a map or the like. 

[01 08] Further, when the human being 1 sits in a chair or stands up from the state of sitting in the chair, a correlation 
shown in Fig. 7 (upon sitting in the chair) or Fig. 8 (upon standing up from the chair) is established between the position 
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of the floor reaction force acting point and the bending angle AOd of the knee joint 10 and, when going upstairs or 
downstairs, Fig. 9 (upon going upstairs) or Fig. 10 (upon going downstairs) is established between the position of the 
floor reaction force acting poin and the inclination angle Be of the thigh portion 9. Therefore, upon sitting in the chair 
or standing up, the position of the floor reaction force acting point can be estimated from the bending angle ABd of the 
5 knee joint 1 0 based on the cor -elation of Fig. 7 or Fig. 8, while, upon going upstairs or downstairs, the position of the 
floor reaction force acting poir I can be estimated from the inclination angle Be or the thigh portion 9 based on the 
correlation of Fig. 9 or Fig. 10. 

[0109] After estimating the position of the floor reaction force acting point as described above, then, the arithmetic 
processing unit 1 6 executes th<> processing of the foregoing joint moment estimating means 37, and derives moments 

10 acting on the knee joint 10 anc the hip joint 8 of. each leg body 2. This processing is carried out based on a so-called 
inverse dynamics model using :urrent-time values of the data respectively derived by the foregoing floor reaction force 
estimating means 36, leg body respective-portion acceleration calculating means 33, leg body respective-portion an- 
gular velocity calculating mears 34, floor reaction force acting point estimating means 35, and leg body posture cal- 
culating means 28. This inverss dynamics model uses an equation of motion for translation motion of each rigid-body 

*5 corresponding portion of the human being 1 and an equation of motion for rotating motion thereof so as to derive 
moments acting on joints in ord jrfrom the joint closerto thefloor reaction force acting point. In the present embodiment, 
the moments acting on the kne e joint 1 0 and the hip joint 8 of each leg body 2 are derived in order 
[0110] More specifically, refe rring to Fig. 11 , at the outset, with respect to the cms portion 11 of each leg body 2, a 
force (joint reaction force) acting on the ankle portion 12 at a tip portion of the cms portion 11, a force (joint reaction 

20 force) acting on the portion of he knee joint 10 of the crus portion 11 , and a translation acceleration of the center of 
gravity G2 of the crus portion 11 are respectively given as T (F-,x, F^), T (F 2 x, F 2 z) : and T (a 2 x, a 2 z) according to the 
component notation in the abs )lute coordinate system Cf , and the weight of the crus portion 1 1 is given as m 2 . In this 
case, an equation of motion fo' the translation motion of the center of gravity G2 of the crus portion 11 becomes the 
following equation (10). 



25 



30 



50 



55 



T (m 2 • a 2 x, m 2 • a 2 z) = T (F 1 x-F 2 x, F.,z-F 2 z - m 2 ■ g) 



therefore. 



T T 

(F 2 x, F 2 z) = (F.,x - m 2 • a 2 x, F.,z - m 2 - a 2 z - m 2 . g) (10) 

[01 11 ] Here, the acceleratior T (a 2 x, a 2 z) of the center of gravity G2 of the crus portion 1 1 is derived by the foregoing 
25 (eg body respective-portion ac:eleration calculating means 33. Further, the joint reaction force T (F-,x, F n z) acting on 
the ankle portion 1 2 at the tip | >ortion of the crus portion 1 1 is approximately equal to the estimated value of the floor 
reaction force derived by the foregoing floor reaction force estimating means 36 for the leg body 2 having the crus 
portion 1 1 . More specifically, in the single stance state, when the leg body 2 is on the ground, the joint reaction force T 
(F^, F-|Z) is the floor reaction force T (Fx, Fz) derived by the foregoing equation (2) and, when the leg body 2 is the 
40 free-leg side leg body, ^F-jX, F ^z)= T {0, 0). On the other hand, in the double stance state, when the leg body 2 is the 
leg body on the rear side of the human being 1 facing forward in the advancing direction, the joint reaction force T (F 1 x, 
F t z) is the floor reaction force "(Frx, Frz) of the foregoing equations (5) and, when the leg body 2 is the front-side leg 
body, it is the floor reaction for :e T (Ffx ; Ffz) of the foregoing equations (5). 

[01 1 2] Therefore, the joint re action force T (F 2 x, F 2 z) acting on the knee joint 1 0 of each leg body 2 is derived from 
45 data about the acceleration T (n 2 x, a 2 z) of the center of gravity G2 of the crus portion 11 derived by the leg body re- 
spective-portion acceleration calculating means 33, data about the floor reaction force (^T^x, F.,z)) derived by the 
floor reaction force estimating means 36, data about the weight m 2 of the crus portion 11 derived in advance, and a 
value of the acceleration of grs vity g, using the foregoing equation (10). 

[0113] Further, referring to F g. 11 , it is given that a moment acting on the ankle portion 12 at the tip portion of the 
crus portion 11 is M 1t a moment acting on the portion of the knee joint 10 of the crus portion 11 is M 2 , a moment of 
inertia about the center of gra\ ity G2 of the crus portion 1 1 is l G2 , and an angular velocity about the center of gravity 
G2 of the crus portion 11 is a 2 . Further, given that, in correspondence with the foregoing figure 4, a distance between 
the center of gravity G2 of the crus portion 11 and the center of the knee joint 10 is t 2 , and a distance between the 
center of gravity G2 of the crus portion 1 1 and the ankle portion 1 2 is t 2 ' (=Ld-t 2 ), an equation of motion for the rotating 
motion about the center of gravity G2 of the crus portion 11 becomes the following equation (11). 

q 2 • ot 2 = M 1 - M 2 -+- F.,x • t 2 ' • cos 6d - F.jZ • t 2 ' - sin Gd 
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F 2 x • t 2 • cos Bd - F 2 7 • t 2 • sin Bd 
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therefore. 



M 2 = M 1 - l G2 • a 2 + F,,x • t 2 ' • cos Bd - F.,z ■ t 2 ' - sin Bd 

+ F 2 x • t 2 • cos 0d - F 2 z • t 2 • sin Bd (11) 



[0114] Here. M 1 in the equatbn (11) is a moment obtained as the outer product (vector product) of a floor reaction 
force acting point vector derived by the foregoing floor reaction force acting point estimating means 35 with respect to 
the leg body 2 having the crus portion 1 1 relating to the equation (1 1 ), and a floor reaction force vector derived by the 
foregoing floor reaction force estimating means 36 with respect to that leg body 2. a 2 is an angular velocity of the crus 
portion 11 derived by the foregoing leg body respective-portion angular velocity calculating means 34. Bd is an incli- 
nation angle of the crus portion 1 1 derived by the foregoing leg body posture calculating means 28. T (F 1 x ; F 1 z) is ; as 
described before, the estimatec value of the floor reaction force derived by the floor reaction force estimating means 
36. Further T (F 2 x, F 2 z) is derived by the foregoing equation (10). The moment of inertia l G2 is derived in advance and 
stored in the arithmetic process ng unit 1 6 along with data about the weight m 2 and size of the crus portion 1 1 . and so 
20 forth. 

[0115] Therefore, the momert M 2 acting on the knee joint 10 is derived from data about the estimated value of the 
floor reaction force by the flooi reaction force estimating means 36, data about the floor reaction force acting point 
vector by the floor reaction force acting point estimating means 35, data about the angular velocity a 2 of the crus portion 
11 by the leg body respective-portion angular velocity calculating means 34, data about the inclination angle Bd of the 
crus portion 11 by the leg body posture calculating means 28. data about the joint reaction force T (F 2 x ; F 2 z) derived 
by the foregoing equation (10) and data about the moment of inertia l G2 , the size (Ld), and the position (t 2 ) of the 
center of gravity G2 of the crus portion 11 derived in advance, using the foregoing equation (11). 
[0116] After deriving the monent M 2 acting on the portion of the knee joint 10 of the crus portion 11 as described 
above, the joint moment estimating means 37 derives, according to the processing like the processing of calculation 
thereof, a moment acting on the portion of the hip joint 8 of the thigh portion 9. The basic idea of this processing is the 
same as the technique of deriving the moment M 2 of the knee joint 10, and therefore, detailed showing and explanation 
are omitted. An outline thereof s as follows 

[0117] Specifically, at the out set, a joint reaction force T (F 3 x : F 3 z) acting on the portion of the hip joint 8 of the thigh 
portion 9 is derived using the following equation (12) (an equation in the same form as the foregoing equation (10)) 
based on an equation of motion for the translation motion of the center of gravity G1 (see Fig. 4) of the thigh portion 9. 

(F 3 x, F 3 z) = T (F 2 x - m 1 - a,,x, F 2 z - m n • a A z - m 1 • g) (12) 

[0118] Here. T (F 2 x, F 2 z) is the joint reaction force of the knee joint 1 0 derived before by the foregoing equation (10). T 
(a.,x, a t z) is an acceleration (trc nsiation acceleration) of the center of gravity G1 of the thigh portion 9 in the absolute 
coordinate system Cf ; which is derived by the foregoing leg body respective-portion acceleration calculating means 
33. Further, m 1 is the weight of the thigh portion 9 derived in advance, and g is the acceleration of gravity. 
[0119] Then, a moment M 3 ac ting on the portion of the hip joint 8 of the thigh portion 9 is derived using the following 
equation (13) (an equation in t\ e same form as the foregoing equation (11)) based on an equation of motion for the 
rotating motion about the cente - of gravity G1 of the thigh portion 9. 



M 3 = M 2 - l G1 • a., + F 2 x • t^ • cos 6c - F 2 z • t.,' • sin Be 

+ F 3 x • t 1 ■ cos Be - F 3 z • t 1 • sin Be (13) 

[0120] Here, M 2 is the moment on the knee joint 10 derived by the foregoing equation (11), T (F 2 x, F 2 z) is the joint 
reaction force on the knee joint 10 derived by the foregoing equation (10), T (F 3 x, F 3 z) is the joint reaction force on the 
hip joint 8 derived by the forego ng equation (12), l G1 is a moment of inertia about the center of gravity G1 of the thigh 
portion 9 derived in advance, a 1 s an angular velocity of the thigh portion 9 derived by the foregoing leg body respective- 
portion angular velocity calculating means 34, and Be is an inclination angle of the thigh portion 9 derived by the 
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foregoing leg body posture calculating means 28. Further t 1 is a distance from the center of the hip joint 8 to the center 
of gravity G1 of the thigh portio i 9 (see Fig. 4), and is a distance from the center of the knee joint 1 0 to the center 
of gravity G1 of the thigh portior 9 (Lc-t 1 in Fig. 4), which are determined based on the position of the center of gravity 
G1 and the size (length) of the high portion 9 derived in advance. 
5 [0121] The processing described above is successively executed per cycle time of the foregoing arithmetic process- 
ing unit 1 6 ; so that the floor reac tion force acting on each leg body 2, and the moments acting on the knee joint 1 0 and 
Lhe hip joint 8 of each leg body 2 are sequentially estimated in real time. 

[0122] Although detailed exp anation is omitted in this specification, the derived estimated values of the moments 
on the knee joints 1 0 and the hir. joints 8 are used for a control of, for example, a device assisting walking of the human 
10 being 1 (a device including electric motors or the iike that can give auxiliary torques to the knee joints 1 0 and the hip 
joints 8). 

[0123] The states of tempera variations of estimated values of floor reaction forces (specifically, absolute values of 
the estimated values of the ftoo reaction forces) derived by the foregoing processing of the arithmetic processing unit 
16 are illustrated in Figs. 12 tc 14 by solid lines. Further, the states of temporal variations of estimated values of 

15 moments on the knee joint 10 and the hip joint 8 derived by the processing of the arithmetic processing unit 16 are 
illustrated in Fig. 1 5 by solid lines. Here, Figs. 12 and 1 5 are illustration wherein the human being 1 walks on a flatland 
at a substantially constant speed, Fig. 13 is illustration wherein the human being 1 walks upstairs, and Fig. 1.4 is 
illustration wherein the human oeing 1 stands up from the state of sitting in a chair. In Figs. 12 to 14, comparative 
examples (corresponding to true values of floor reaction forces) obtained by actually measuring floor reaction forces 

20 using a force meter or the like ire also shown by imaginary lines. Further, in Fig. 15, comparative examples (corre- 
sponding to true values of moments on the knee joint 1 0 and the hip joint 8) obtained by actually measuring moments 
on the knee joint 1 0 and the hip joint 8 using a torque meter or the like are also shown by imaginary lines. 
[0124] As is clear by referring to Figs 12 to 14, it is understood that, according to the present embodiment, the 
accurate estimated values of the floor reaction forces are obtained irrespective of the motion type or motion environment 

25 of the leg bodies 2. Further, in he present embodiment, as shown in Fig. 15, the moments on the knee joint 10 and 
the hip joint 8 can also be estimated with relatively high accuracy using the estimated values of the floor reaction forces. 
[01 25] As described above, a< cording to this embodiment, it is possible to easily estimate in real time the floor reaction 
force acting on each leg body s: and the moments acting on the hip joint 8 and the knee joint 10 of each leg body 2 
using relatively small and light : tensors such as the angle sensors 22 and 23 respectively attached to the hip joints 8 

30 and the knee joints 10, and the gyro sensors 14 and 19 and the accelerometers 15, 20, and 21 attached to the body 
5 : without attaching such sense rs to the leg bodies 2 that become obstructive to the walking of the human being 1 , or 
apply loads to the motion of the eg bodies 2. Moreover, such estimation can be carried out with relatively high accuracy 
irrespective of the motion type c r motion environment of the leg bodies 2. i.e. whether it is walking on a flatland, walking 
on the stairs, or the like. 

35 [01 26] I n the embodiment de; cribed above, the description has been given about the case, as an example, wherein 
the present invention is appliec to the human being 1. However, the present invention is also applicable to a bipedal 
walking robot as a bipedal wall ing moving body. Here, in case of the bipedal walking robot, it may have a structure 
where a waist and a chest are integral with each other. In this case, it is possible to attach the gyro sensor and the 
forward/backward accelerometir to either one of the waist and the chest, and estimate floor reaction forces and mo- 

40 ments on joints of leg bodies in : he same manner as in the present embodiment. Further, in case of the bipedal walking 
robot, it is also possible grasp >ending angles of hip joints and knee joints based on control amounts of a controller 
for actuators of those joints. 

[0127] In the foregoing embo iiment, the detection data of the waist upward/downward accelerometer 21 is uses as 
it is for judging the motion state of the leg bodies 2. However, instead of such detection data, it is possible to use, for 
45 example, values of component . \ of the acceleration a 0 of the waist 3 in the vertical direction (Z-axis direction) in the 
absolute coordinate system Cf, which are derived by the foregoing reference acceleration measuring means 27. 

INDUSTRIAL APPLICABILITY 

so [0128] As described above, t le present invention is useful in that when performing walking assistance or walking 
control of a bipedal walking mo/ing body such as a human being or a robot, floor reaction forces and joint moments 
acting on leg bodies of the mov ng body can be grasped. 



55 Claims 



1. A method of estimating a f oor reaction force acting on each of leg bodies of the bipedal walking moving body, 
comprising: 
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a first step of judging whether a motion state of the leg bodies of said bipedal walking moving body is a single 
stance state in which c nly one of the leg bodies touches the ground, or a double stance state in which both 
leg bodies touch the giound; 

a second step of sequentially deriving positions of the center of gravity of said bipedal walking moving body, 
and sequentially deriving accelerations of said center of gravity in an absolute coordinate system fixed relative 
Lo the ground by the us e of time series data about the positions of said center of gravity; 
a third step of sequent ally deriving positions of a specific portion relative to said center of gravity at least in 
said double stance state, said specific portion predetermined in the neighborhood of a lower end portion of 
each leg body; 

a step of deriving estimated values of said floor reaction force acting on the leg body touching the ground 
sequentially, in the single stance state of said bipedal walking moving body, based on an equation of motion 
for said center of gravi y expressed by a weight and an acceleration of gravity of the bipedal walking moving 
body ; the acceleration of said center of gravity, and said floor reaction force acting on the leg body touching 
the ground; and 

a step of deriving estimated values of said floor reaction forces respectively acting on both leg bodies sequen- 
tially, in the double star ce state of said bipedal walking moving body ; based on an equation of motion for said 
center of gravity expressed by a weight and an acceleration of gravity of the bipedal walking moving body, the 
acceleration of said center of gravity, and said floor reaction forces respectively acting on both leg bodies, and 
an expression of relation between the position of said specific portion of each leg body relative to said center 
of gravity and said fiocr reaction force acting on said leg body, said expression of relation being determined 
based on assumption 1hat said floor reaction force acting on each leg body acts from said specific portion of 
said leg body toward said center of gravity. 

A method according to claim 1 , wherein said specific portion of each leg body is an ankle portion of said leg body. 

A method according to claim 1 , further comprising a step of measuring an acceleration, in an upward/downward 
direction, of a lower portion of a body supported on both leg bodies via a hip joint of each leg body, said lower 
portion of the body located near said hip joints, 

wherein, in said first step, the motion state of said bipedal walking moving body is judged such that when 
the acceleration of said low er portion of the body in the upward/downward direction increases to a predetermined 
threshold value or more, said double stance state starts while said single stance state finishes and, when the 
estimated value of said floor reaction force acting on the leg body which precedingly makes a takeoff is lowered 
to a predetermined thresho d value or less in said double stance state, said double stance state finishes while said 
single stance state starts. 

A method according to clai n 1 , further comprising a step of respectively measuring an inclination angle of a body 
supported on both leg bodies via a hip joint of each leg body, bending angles respectively of at least the hip joint 
and a knee joint of each leci body, and an acceleration of a predetermined reference point of said bipedal walking 
moving body in said absolite coordinate system, 

wherein, in said second step, based on the inclination angle of said body, the bending angles respectively 
of said hip joints and said f nee joints, a rigid body link mode! formed by expressing said bipedal walking moving 
body as a linked body of a plurality of rigid bodies, prederived weights of respective rigid-body corresponding 
portions of the bipedal waking moving body corresponding to the respective rigid bodies of said rigid body link 
model and positions of the prederived centers of gravity of the rigid-body corresponding portions in the respective 
rigid-body corresponding portions, positions of the center of gravity of said bipedal walking moving body reiative 
to said reference point are sequentially derived, accelerations of said center of gravity relative to said reference 
point are sequentially derived based on time series data about the positions of said center of gravity and the 
acceleration of said center of gravity in said absolute coordinate system is derived from the acceleration of said 
center of gravity relative to said reference point, and the acceleration of said reference point in said absolute 
coordinate system. 

A method according to clai n 4, wherein said reference point is set to said body. 

A method according to claim 4, wherein said body has a waist coupled to both leg bodies via the hip joints, and a 
chest located on said waisi so as to be tiltable relative to said waist, and the inclination angle of said body used 
for deriving the position of >aid center of gravity comprises inclination angles respectively of said waist and said 
chest. 
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7. A method according to c!ai n 6, wherein said rigid body link model is a model expressing a cms portion located on 
a lower side of the knee jo nt of each leg body of said bipedal walking moving body, a thigh portion between said 
knee joint and said hip joi it, said waist, and an upper body portion located on an upper side of said waist and 
including said chest, as rigid bodies, respectively. 

5 

8. A method of estimating a moment acting on at least one joint of each leg body of the bipedal walking moving body 
by the use of the estimalec values of the floor reaction force on each leg body sequentially derived by the method 
according to claim 1 , comr. rising: 

10 a step of respectively measuring an inclination angle of a body supported on both leg bodies via a hip joint of 

each leg body, bendin :j angles respectively of at least the hip joint and a knee joint of each leg body, and an 
acceleration of a predetermined reference point of said bipedal walking moving body in said absolute coordi- 
nate system; 

a step of sequentially c eriving inclination angles of respective rigid-body corresponding portions of the bipedal 
15 walking moving body corresponding to the respective rigid bodies of said rigid body link model, based on the 

inclination angle of said body, the bending angles respectively of said hip joint and said knee joint of each leg 
body : and a rigid body link model formed by expressing said bipedal walking moving body as a linked body of 
a plurality of rigid bodies; 

a step of sequentially deriving positions of the centers of gravity of the respective rigid-body corresponding 

20 portions relative to sa d reference point, based on the inclination angles of said respective rigid-body corre- 

sponding portions, pre derived weights of the respective rigid-body corresponding portions, and positions of 
the prederived center* of gravity of the rigid-body corresponding portions in the respective rigid-body corre- 
sponding portions, anc sequentially deriving accelerations of the centers of gravity of the respective rigid-body 
corresponding portions relative to said reference point based on time series data about the positions of the 

25 centers of gravity of the respective rigid-body corresponding portions; 

a step of sequentially c eriving accelerations of the centers of gravity of the respective rigid-body corresponding 
portions in said absoli te coordinate system from the accelerations of the centers of gravity of the respective 
rigid-body correspond ng portions relative to said reference point, and the accelerations of said reference point 
in said absolute coord nate system; 

30 a step of sequentially deriving angular velocities of the respective rigid-body corresponding portions based on 

time series data abou* the inclination angles of the respective rigid-body corresponding portions; 
a step of sequentially deriving estimated positions of a floor reaction force acting point of each leg body in 
said bipedal walking moving body, based on at least one of an inclination angle of a thigh portion of said leg 
body and the bending angle of the knee joint of said leg body as the rigid-body corresponding portions of said 

35 bipedal walking moving body; and 

a step of estimating a moment acting on at least one of the joints of each leg body of said bipedal walking 
moving body based on an inverse dynamics model using the estimated value of said floor reaction force, the 
estimated position of ;>aid floor reaction force acting point, the accelerations of the centers of gravity of the 
respective rigid-body c orresponding portions and the angular velocities of said rigid-body corresponding por- 

40 tions in said absolute coordinate system, the inclination angles of the respective rigid-body corresponding 

portions, the prederivc d weights and sizes of the respective rigid-body corresponding portions, the positions 
of the prederived centers of gravity of the rigid-body corresponding portions in the respective rigid-body cor- 
responding portions, £ nd prederived moments of inertia of the respective rigid-body corresponding portions. 

45 g. A method of estimating a n loment acting on at least one joint of each leg body of the bipedal walking moving body 
by the use of the estimatec values of the floor reaction force on each leg body sequentially derived by the method 
according to claim 4, comprising: 

a step of sequentially jeriving inclination angles, in said absolute coordinate system, of the respective rigid- 
50 body corresponding p< >rtions of the bipedal walking moving body corresponding to the respective rigid bodies 

of said rigid body fink nodel, based on the inclination angle of said body, the bending angles respectively of 
said hip joint and said knee joint of each leg body, and said rigid body link model; 

a step of sequentially deriving positions of the centers of gravity of the respective rigid-body corresponding 
portions relative to said reference point, based on the inclination angles of said respective rigid-body corre- 
55 sponding portions, the prederived weights of the respective rigid-body corresponding portions, and the posi- 

tions of the centers of gravity of the rigid-body corresponding portions in the respective rigid-body correspond- 
ing portions, and sequentially deriving accelerations of the centers of gravity of the respective rigid-body cor- 
responding portions re ative to said reference point based on time series data about the positions of the centers 
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of gravity of the respective rigid-body corresponding portions; 

a step of sequentially deriving accelerations of the centers of gravity of the respective rigid-body corresponding 
portions in said absolu e coordinate system from the accelerations of the centers of gravity of the respective 
rigid-body corresponds g portions relative to said reference point, and the accelerations of said reference point 
in said absolute coordi late system 

a slep of sequentially dsriving angular velocities of the respective rigid-body corresponding portions based on 
time series data about ihe inclination angles of the respective rigid-body corresponding portions: 
a step of sequentially deriving estimated positions of a floor reaction force acting point of each leg body in 
said bipedal walking msving body, based on at least one of an inclination angle of a thigh portion of said teg 
body and the bending g ngle of the knee joint of said leg body as the rigid-body corresponding portions of said 
bipedal walking movinci body; and 

a step of estimating a noment acting on at least one of the joints of each leg body of said bipedai walking 
moving body based on an inverse dynamics model using the estimated value of said floor reaction force, the 
estimated position of said floor reaction force acting point, the accelerations of the centers of gravity of the 
respective rigid-body corresponding portions and the angular velocities of said rigid-body corresponding por- 
tions in said absolute coordinate system, the inclination angles of the respective rigid-body corresponding 
portions, the prederive i weights and sizes of the respective rigid-body corresponding portions, the positions 
of the prederived centers of gravity of the rigid-body corresponding portions in the respective rigid-body cor- 
responding portions, and prederived moments of inertia of the respective rigid-body corresponding portions. 
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FIG.1 Co) 
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FIG. 2 
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